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Abstract 

Principal  Base  Parameter  Analysis  (PBPA)  is  a  general  and  systematic  proce¬ 
dure  for  determining  the  dynamic  parameters  that  directly  contribute  to  the  joint 
torques  of  a  manipulator,  ranked  in  order  of  sensitivity.  The  feasibility  of  employing 
PBPA  as  an  aid  in  the  design  and  tuning  of  adaptive  model-based  controllers  for 
industrial  manipulators  is  rigorously  investigated.  This  is  acc^^nplished  by  employ¬ 
ing  PBPA  to  determine  the  minimal  size  of  the  adaptive  parameter  vector  and  more 
importantly,  to  develop  a  less  heuristic  procedure  for  controller  tuning.  A  simple, 
step-by-step  procedure  is  developed  wherein  the  manipulator  torque  equations  are 
used  in  conjunction  with  PBPA  to  develop  a  functional  adaptive  model-based  control 
(AMBC)  algorithm,  then  tune  the  algorithm  for  optimal  performance.  Experimen¬ 
tal  analysis  contrasts  this  adaptive  model-based  controller,  designed  and  tuned  using 
PBPA,  to  the  completely  heuristic  procedure  employed  in  previous  Air  Force  Insti¬ 
tute  of  Technology  research.  The  incorporation  of  PBPA  into  the  AMBC  design 
methodology  reduces  the  time  and  expertise  necessary  to  tune  the  controller  for 
satisfactory  tracking  performance. 
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Principal  Base  Parameter  Analysis:  Implementation  and  Analysis  in 
an  Adaptive  Model-Based  Robotic  Controller 


J.  Problem  Description 


1.1  Background 

The  Air  Force  must  be  able  to  sustain  operations  in  environments  ranging  from 
the  sub-zero  temperatures  of  Thule,  Greenland  to  the  deserts  of  the  Persian  Gulf. 
In  addition,  during  war  time,  we  may  need  to  operate  in  a  chemical,  biological  or 
nuclear  environment.  In  these  situations,  it  may  be  undesirable  or  impossible  to  use 
human  operators.  Robots  may  be  the  answer  to  this  problem;  however,  if  robots  are 
to  be  used  in  demanding  Air  Force  applications,  further  research  is  necessary  in  the 
area  of  advanced  control  algorithms. 

One  existing  method  of  controlling  robots,  generically  called  classical  control,  is 
to  feed  back  position  and  velocity  information  into  the  control  circuitry  which  causes 
a  modification  of  the  control  torque.  Many  classical  control  algorithms  can  supply 
fairly  accurate  positioning,  but  only  over  specifically  defined  trajectories.  A  more 
serious  drawback  of  classical  control  algorithms  is  that  they  tend  to  either  suffer 
degraded  tracking  accuracy  or  become  entirely  unstable  in  the  presence  of  external 
disturbances  or  variable  payloads.  In  an  effort  to  make  robots  more  general  purpose, 
as  well  cis  consistently  accurate  over  varied  conditions,  different  control  algorithms 
are  being  researched.  One  of  the  more  promising  classes  of  algorithms  under  in¬ 
vestigation  is  Adaptive  Model-Based  Control  (AMBC).  Unlike  classical  methods  of 
control,  which  rely  on  well  defined  manipulator  dynamics,  AMBC  uses  an  estimated 
system  model  and  modifies  feedforward  motor  torques  based  on  position  and  veloc¬ 
ity  errors.  Furthermore,  the  estimated  system  model  is  refined  with  each  successive 
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pass  over  a  given  trajectory.  In  other  words,  this  type  of  algorithm  has  the  ability 
to  adapt  to  changing  environments. 

Previous  studies  at  the  Air  Force  Institute  of  Technology  have  demonstrated 
that  the  tracking  accuracy  of  a  robot  can  show  significant  improvement  when  Adap¬ 
tive  Model-Based  Control  is  used  [16, 22].  Unfortunately,  in  order  to  achieve  optimal 
performance,  these  studies  have  had  to  employ  heuristic,  manpower  intensive  meth¬ 
ods  to  fine  tune  the  algorithm.  The  prime  objective  of  this  study  has  been  to  move 
the  tuning  process  av/ay  from  this  iterative,  experimental  nature. 

The  remainder  of  this  chapter  will  be  devoted  to  exactly  what  the  problem  is, 
as  well  as  how  it  was  addressed.  First,  the  problem  will  be  explored  more  in  depth, 
both  in  terms  of  what  the  problem  attributes  are  and  why  this  subject  rates  further 
study.  Next,  a  general  outline  of  the  approach  and  methodology  of  this  study  will 
be  presented.  This  roadmap  of  the  research  will  cover  not  only  what  was  done  and 
what  physical  resources  were  used,  but  also  what  the  final  goal  was. 

1.2  Problem  Statement  and  Objective 

As  already  stated,  previous  studies  at  the  Air  Force  Institute  of  Technology 
(AFIT)  have  demonstrated  that  the  tracking  accuracy  of  a  robot  can  show  signif¬ 
icant  improvement  over  simple  feedback  controllers  when  Adaptive  Model-Based 
Control  (AMBC)  is  used  [16,  22].  For  a  typical  AMBC  algorithm,  the  total  joint 
torque  applied  is  the  feedback  (i.e.  Proportional-Derivative  or  PD)  torque  added  to  a 
feedforward  torque.  This  feedforward  torque  is  typically  determined  real-time  by  the 
adaptive  algorithm.  Specifically,  the  feedforward  torque  is  determined  on  a  joint-by¬ 
joint  basis  ^nd  overall,  is  a  product  of  a  regressor  matrix  (Y)  and  a  parameter  vector 
(a).  The  regressor  matrix  is  comprised  of  all  the  non-linear  terms  of  the  manipulator 
torque  equations  while  the  the  parameter  vector  is  made  up  of  the  known  dynamic 
terms  and  an  estimate  of  the  unknown  dynamic  terms.  The  estimated  portion  of 
d  is  the  product  of  the  regressor  transposed,  the  position  and  velocity  errors  and  a 
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diagonal  adaptive  gain  matrix,  all  integrated  over  time.  These  terms,  cis  well  as 
their  usage,  will  be  discussed  more  in  depth  in  the  following  chapters.  The  adaptive 
gain  matrix,  F"^ ,  is  what  was  actually  tuned  with  the  aforementioned  heuristic,  man¬ 
power  intensive  tuning  process.  One  of  the  previous  AFIT  studies,  done  by  Leahy 
and  Whalen,  used  a  F“^  of  16  diagonal  elements,  each  ranging  in  value  from  0  to  150 
[16].  Assuming  complete  independance  of  the  elements,  total  possible  combinations 
of  values  approaches  infinity.  For  the  Leahy  and  Whalen  AMBC  development,  the 
tuning  was  performed  over  the  course  of  months,  by  individuals  very  well  versed  in 
the  dynamics  of  that  particular  manipulator.  Leahy  and  Whalen  have  stated  that 
the  tuning  process  is  more  an  art  form  than  a  science  and  that  changing  the  F“^ 
values  could  result  in  either  improved  performance  or  disaster  [16]. 

If  it  is  desired  to  develop  an  AMBC  algorithm  for  a  general  manipulator,  the 
question  remains  -  is  there  a  procedure  to  develop  and  tune  said  algorithm  with¬ 
out  employing  heuristics  or  extensive  a  priori  knowledge  of  manipulator  dynamics? 
While  it  may  be  acceptable  to  spend  months  tuning  a  specific  manipulator  for  a 
specific  task  in  a  laboratory  environment,  such  a  time  consuming  process  negates 
many  of  the  AMBC  benefits  in  the  context  of  day-to-day  operation.  Therefore,  the 
objective  of  this  study  was  to  develop  a  straightforward  AMBC  design  procedure 
that  eliminates  or  reduces  the  amount  of  heuristics  used  when  tuning  the  algorithm 
for  optimal  performance. 

1.3  Application  of  Principal  Base  Parameter  Analysis 

One  way  in  which  the  tuning  process  could  be  simplified  would  be  to  establish  a 
relationship  of  each  element  of  the  parameter  vector  to  the  other  elements.  Assuming 
that  such  a  relationship  could  be  found,  the  parameter  vector  could  then  be  tuned 
as  a  whole,  using  a  single  scaling  factor,  as  opposed  to  the  exhaustive  combinational 
analysis  described  in  the  previous  section.  A  method  of  parameter  analysis,  recently 
proposed  by  Ghodoussi  and  Nakamura,  might  be  able  to  be  used  in  this  application. 
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Their  procedure,  Principal  Base  Parameter  Analj^sis  reduces  the  parameter  set  of 
a  manipulator  to  an  absolute  minimum  and  ranks  the  resultant  parameter  vector 
elements  in  order  of  sensitivity  [5].  As  a  byproduct,  PBPA  yields  an  element-to- 
element  relationship  in  the  resultant,  reduced  parameter  vector.  Ghodoussi  and 
Nakamura  suggest  that  this  element  to  element  relationship  may  be  of  use  in  a 
control  application. 

PBPA  starts  from  the  fact  that  each  joint  of  a  robot  has  ten  associated  primitive 
dynamic  parameters,  which  describe  how  it  is  moved  and  positioned  [20].  These 
primitive  dynamic  parameters  are  the  link  mass  m,  the  independent  elements  of  the 
inertia  tensor  I^x,  lyy,  hz,  hy,  Ixz,  Jyz  and  the  three  position  elements  of  the  meiss 
centroid,  Ty,  (5).  When  moving  the  end  effector  into  some  arbitrary  position, 
some  of  these  parameters  are  more  important  than  others  and  some  parameters  will 
be  redundant.  The  base  parameter  set  is  defined  as  the  minimal  set  of  parameters 
necessary  to  fully  describe  the  dynamics  of  a  manipulator.  Several  methods  have 
been  proposed  to  quantify  how  many  parameters  make  up  the  base  parameter  set 
[8,  4];  however,  the  method  presented  by  Ghodoussi  and  Nakamura  not  only  identifies 
the  minimal  parameters  specifically,  but  also  ranks  them  in  order  of  sensitivity.  This 
reduced,  ranked  parameter  set  is  called  the  principal  base  parameter  set. 

Principal  Base  Parameter  Analysis  is  a  method  to  reduce  the  parameter  set  to 
a  minimum  and  coincidently,  establishes  an  element  to  element  relationship  in  the 
reduced  parameter  vector  [5].  This  study  has  taken  that  assumption  and  used  it  to 
develop  an  AMBC  algorithm  that  can  tuned  with  a  single  scaling  factor  versus  the 
previous  heuristic  tuning  method. 

1.4  Method  of  Attack 

The  first  thrust  of  this  study  was  to  perform  PBPA  on  the  PUMA-560  con¬ 
figured  as  a  two  degree  of  freedom  platform  (actuating  only  joints  two  and  three). 
While  this  portion  of  the  study  has  little  real-world  application,  it  serves  to  illus- 
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trate  the  concepts.  The  analysis  was  then  expanded  to  a  three  degree  of  freedomxase 
(joints  one.  two  and  three  actuated).  The  results  obtained  via  PBPA  for  ihe  three 
are  then  incporporated  into  an  adaptive  model-based  control  algorithm.  Einally,  to 
verify  that  this  technique  is  not  platform  specific,  the  same  procedure  was  applied 
to  a  totally  disparate  manipulator,  the  Utah/MIT  Dexterous  Hand  (UMDH). 

IJf.l  Incorporation  of  PBPA  into  an  AMBC  algorithm 

As  discussed  in  the  proceeding  sections,  PBPA  yields  a  reduced  parameter  set, 
ranked  in  order  of  sensitivity.  An  overview  of  how  this  reduced  parameter  set  is 
incorporated  into  an  AMBC  algorithm  is  cis  follows;  specifics  and  description  of 
terms  will  follow  in  later  chapters.  First,  the  reduced  parameter  vector  was  used  in 
place  of  the  the  linear  parameter  vector,  a,  in  an  AMBC  algorithm.  Next,  using  the 
original  torque  equations  for  the  three  degree  of  freedom  PUMA  and  this  parameter 
vector,  a  new  regressor  matrix  was  determined  (such  that  the  product  of  the  regressor 
and  the  parameter  vector  equaled  the  original  torque  equations).  Finally,  since  the 
parameter  set  consists  only  of  physical  values  (i.e.  link  lengths,  masses,  gravity),  the 
best  estimate  of  physical  values  were  substituted  into  the  reduced  parameter  vector. 
This  substitution  yielded  a  vector  of  strictly  numerical  values.  This  set  of  numerical 
values  was  then  used  as  the  base  P"^  values  in  the  AMBC  algorithm.  From  this  point 
on,  all  tuning  of  the  algorithm  was  accomplished  by  multiplying  the  F"^  matrix  by 
a  single  scaling  factor. 

IJ/.S  Experimental  Verification  and  Validation  of  Technique 

Upon  completion  of  the  AMBC  dc.dgn,  an  exhaustive  experimental  analysis  was 
performed  to  provide  validation  and  verification  of  the  proceedure.  The  trajectory 
set,  as  detailed  by  Leahy  and  Whalen  [16],  was  performed  to  remain  consistant 
with  previous  AFIT  research.  Additionally,  this  previous  AFIT  study  was  used 
as  the  benchmark  with  which  to  deteriwine  success  or  failure  of  the  AMBC/PBPA 
design  and  tuning  technique.  As  was  done  by  Leahy  and  Whalen,  this  study  also 
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investigated  such  items  as  the  effect  of  payload  and  parameter  reduction  on  tracking 
accuracy. 


IJf.S  Cross  Check  of  Technique  on  a  Se(or.\  is 'form 

In  order  to  prove  that  this  technique  of  a%  'V  waning  is  not  just  applicable 
to  the  PUMA,  PBPA  and  the  associated  AMBC  lining  was  also  planned  for  the 
Utah/MIT  Dexterous  Hand.  It  was  hoped  that  i;.!.-  cross  '.heck  would  prove  that 
the  technique  developed  here  could  be  iplied  aci  .'ss  a  range  of  robots.  The  study 
done  at  AFIT  by  Rainey  had  already  developed  a  control  algorithm  development 
environment  for  the  UMDH;  however,  since  the  time  of  that  study,  the  host  computer 
and  operating  system  had  changed  [22].  This  change  of  host  precipitated  changes 
in  bo^^h  the  code  and  the  communications  interface  to  the  robot.  Consequently, 
significant  effort  was  required  before  PBPA  and  the  eissociated  algorithm  tuning 
could  be  accomplished  on  the  UMDH.  Due  to  delays  in  hardware  developin..at,  the 
UMDH  portion  of  this  effort  was  not  brought  to  fruition.  PBPA  was  performed  on 
the  UMDH  and  the  results  were  in-'.<>rporated  into  an  AMBC  algorithm;  however, 
no  experimental  analysis  v/as  performed.  Therefore,  no  conclusions  can  be  drawn  as 
to  how  well  this  design  procedure  works  on  the  UMDH. 

1.5  Materials  and  Equipment 

This  study  has  been  performed  using  equipment  and  software  resident  in  the 
Air  Force  Institute  of  Technology  Signal  Processing  Lab.  Specifically: 

•  PUMA-560  Vertically  Articulated  Robot 

•  AFIT  Robotic  Control  Algorithm  Development  and  Evaluation  (ARCADE)  en¬ 
vironment 

«  Sun  Sparc2  Workstation 

•  Mathematica  Software  [28] 
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•  Utah/MIT  Dexterous  Hand 

•  SARCOS  Hand  Control  Electronics  [10] 

•  Ironies  IV-3272  System  Controller  [9] 

•  Ironies  IV-3201  VME-bus  Multiprocessing  Engine 

«  Data  Translation  DT1401  Series  A/D  anl  D/A  Converters 

•  VME  ChdSrfis 

•  Sun  Sparc2  Workstation 

•  CHIMERA  II  Real-time  Programming  Environment  [2] 

The  PUMA  version  of  ARCADE  is  hosted  on  a  VAXstation  HI  and  hcis  both 
serial  and  parallel  connections  to  the  original  PUMA  computer  bus.  The  PUMA’s 
LSI-11/73  serves  as  a  preprocessor.  Communications  restrictions,  minimal  processing 
time  and  nominal  clock  rate  resulted  in  a  servo  rate  of  4.5  msec  (222  Hz)  for  the 
experimental  evaluations  [16].  The  UM  rl  version  of  ARCADE  was  developed  and 
hosted  on  and  IBM  PC/AT-386  and  interfaced  to  the  UMDH  via  an  IV3201  real-time 
processing  engine  by  IRONICS  [22].  The  AMBC  algorithm  required  a  minimum  of 
3.0  msec  (333  Hz)  servo  rate  due  to  access  and  set-up  times  for  the  A/D  and  D/A 
convertors.  Ss  a  first  step  to  performing  and  testing  the  PBPA  design  procedure  on 
Ihe  UMDH,  he  previously  developed  software  was  re-hosted  to  a  Sparc2  workstation 
with  the  CHIMERA  II  programming  environment.  This  re-hosting  proceeded  only 
to  the  point  where  the  AMBC  software  was  compiled.  The  continuation  of  this  effort 
will  be  the  subject  of  future  study. 

1.6  Contributions 

AMBC  type  controllers  have  demonstrated  greatly  improved  tracking  accuracy 
over  simple  feedback  controllers  alone.  However,  the  manpower  intensive  tuning  that 
this  class  of  algorithm  requires  to  achieve  optimal  performance  has  made  AMBC 
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unattractive  for  use  in  other  that  a  laboratory  environment.  This  study  develops 
and  verifys  a  simple  step-by-step  procedure  by  which  an  AMBC  algorithm  can  be 
implemented  and  tuned  for  optimal  tracking  accuracy.  Using  this  procedure,  an 
AMBC  algorithm  can  be  tuned  for  different  applications  in  a  matter  of  hours,  versus 
the  current  time  of  months.  Furthermore,  thi.  tuning  can  be  done  by  a  person  with 
little  or  no  knowledge  of  the  manipulator  dynamics.  The  procedure  developed  herein 
is  the  first  step  in  moving  AMBC  out  of  the  laboratory  and  into  the  field. 

1.7  Summary 

This  chapter  has  described  the  profiems  associated  with  AMBC  type  algorithms 
and  how  this  study  proposes  to  solve  theiu.  Chapter  2  will  explore  current  literature 
for  research  trends  in  this  area.  Chapter  2  will  describe  the  AMBC  design  procedure 
and  illustrate  the  same  with  an  example.  Experimental  results  are  contained  in 
chapter  4  and  the  final  chapter  contains  conclusions  and  recon;  .nendations  for  future 
study. 
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IL  Literature  Review 


2.1  Introduction 

Recent  research  throughout  the  robotics  community  has  extensively  investigated 
the  topic  of  Adaptive  Model-Based  Control  (AMBC).  Two  studies  recently  completed 
at  the  Air  Force  Institute  of  Technology  (AFIT)  have  implemented  AMBC  algorithms 
pn  both  the  PUMA-560  vertically  articulated  robot  [16]  and  the  Utah/MIT  Dexter¬ 
ous  Hand  (UMDH)  [22].  These  studies  both  demonstrated  that  the  tracking  accuracy 
of  a  robot  can  show  significant  improvement  over  simple  feedback  controllers  when 
an  Adaptive  Model-Based  Control  algorithm  is  used.  A  problem  encountered  in  both 
of  the  forementioned  AFIT  studies  was  the  method  in  which  the  AMBC  algorithm 
was  fine  tuned  for  optimal  performance.  In  both  cases,  heuristic,  manpower  inten¬ 
sive  methods  were  used  to  tune  the  algorithm  as  well  as  to  reduce  the  parameter 
set.  The  purpose  of  this  literature  review  is  to  quantify  the  current  state  of  research 
in  the  areas  of  AMBC  development,  tuning  of  the  AMBC  algorithms  for  optimal 
performance  as  well  as  parameter  set  reduction  techniques. 

2.2  Adaptive  Model-Based  Control 

For  a  typical  AMBC  algorithm,  the  total  joint  torque  applied  is  the  feedback 
(i.e.  Proportional-Derivative  or  PD)  torque  added  to  a  feedforward  torque. 


'^tstal  —  'r/6  -|-  TfJ  (^'1) 

This  feedforward  torque  is  typically  determined  real-time  by  the  adaptive  al¬ 
gorithm.  Specifically,  the  feedforward  torque  is  a  product  of  a  regressor  matrix  (Y) 
and  a  parameter  vector  (a).  The  feedforward  torque  equation  may  be  of  the  form: 

Vf  =  ^  i^d,  (id,  qd)a  (2.2) 
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where 


Y {qd,  Qd,  qd)  =  regressor  matrix  where  y  g (2.3) 

a  —  linear  parameter  vector  where  a  G  ^paramctersxi  _  (2.4) 

qd  =  desired  position  (2.5) 

qd  =■  desired  velocity  (2.6) 

qd  =  desired  acceleration  (2.7) 


The  regressor  matrix  is  comprised  of  all  the  non-linear  terms  of  the  manipulator 
torque  equations  while  the  the  parameter  vector  is  made  uo  of  the  known  dynamic 
terms  and  an  estimate  of  the  unknown  dynamic  terms  (e.g.  gravity,  inertias,  masses, 
link  lengths).  For  a  general  2  degree  of  freedom  case  the  regressor  would  be  [21]: 


Y{qd,qd,qd)=  (2.8) 

qdi  qd2  qdi  +  qd2  2cosqd2qdi  +  cosqd2qd2  -  2$inqd2qdiqd2  -  sinqd2qd2^ 

0  0  ?di  -f-  qd2  cosqd2qdi  +  sinqd2qd2^ 

qdi  qd\  +  qd2  cosqdi  cosqdi  cos{qdi  +  qd2)  qdi  o  sgnqdi  0 

0  (jdi  +qd2  0  0  cos{qdi  +  qd2)  0  qd2  0  sgnqd2 


where  sign(x)  is  defined  cis; 


$gn{x) 


1  a:>0 

-1  a:  <  0 

\ 


(2.9) 


Equation  2-2  can  also  be  written  as 
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VI  =  YiiQd,  qd,  qd)a  +  Y2{qd,  (Id,  qd)K 


(2.10) 


where  a„  contains  the  known  parameters  and  a  contains  the  estimated  parameters. 

This  control  algorithm  adapts  to  new  situations  because  the  estimated  portion 
of  the  parameter  vector  is  refined  with  each  subsequent  pass  over  a  given  trajectory. 
Slotine  and  Li  have  proposed  an  approach  to  AMBC  that  uses  this  parameter  re¬ 
finement  approach  to  also  compensate  for  controller  limitations  [25].  Their  equation 
for  the  linear  parameter  vector  is  as  follows  [22]: 

«  =  /  q,  qr,  qr)[iqd  -  ?)  +  Hqd  -  ?)]  (2.11) 

where 

qr  =  qd  +  Hqd  ~  q)  (2.12) 

qr  =  qd  +  Hqd  -  q)‘  (2.13) 

is  a  diagonal  matrix,  whose  values  control  the  adaption  of  the  individual 
a  parameters;  A  is  a  ratio  of  the  position  to  velocity  feedback  gains  (A  =  KpfKv)- 
The  Slotine  and  Li  algorithm  has  been  successfully  implemented,  however,  it  has 
proven  unreliable  in  the  presence  of  velocity  measurement  noise  [7].  Sadegh  and 
Horowitz  have  proposed  another  method  of  AMBC  implementation  which  they  call 
’’Desired  Compensation  Adaptation  Law”[23].  Previous  AFIT  studies  have  validated 
the  performance  potential  of  this  approach  to  Direct  Adaptive  Control  [16,  22].  This 
implementation  and  study  of  AMBC  algorithms  has  been  the  subject  of  on-going 
research  at  the  Air  Force  Institute  of  Technology  (AFIT). 

2.2.1  AFIT  Research 

Research  at  the  Air  Force  Institute  of  Technology  has  included  the  evaluation 
of  Adaptive  Model-Bcised  Control  (AMBC)  algorithms  on  two  very  disparate  ma- 


nipulators.  The  same  equations  have  been  implemented  on  both  platforms  and  have 
yielded  roughly  the  same  results  -  that  is,  both  robots  experienced  increased  tracking 
accuracy  after  successive  pcisses  over  a  single  trajectory.  Both  of  the  implementa¬ 
tions  that  will  be  discussed  were  performed  using  a  digital  computer.  The  delay 
inherent  in  a  digital  implementation  is  handled  by  using  the  error  information  from 
the  previous  sample  time  in  the  current  cj'cle  output  torque  calculations  [15].  This 
causes  the  equations  to  take  the  following  form: 


’■//(*)  =  +  Y2lqj{k),qj{k),q4l‘)]HI‘)  {2.M) 

»W=  r  r-’J^’’fe(t).?d{i),Mt))[c(A--l)  +  Ac(t-l)l  (2.15) 

JQ 

-  1)  =  -  1)  -  m  -  1)  -  qik  -  2)]/Z  (2.16) 

e{k  -  1)  =  qd{k  -  1)  -  q{k  -  1)  (2.17) 

Tji,  =  K£)c{k  —  i)  +  Kpe{k —  1)  (2.18) 


where  Tj  is  the  sample  period  and  the  integration  was  accomplished  using  the  Adams- 
Bashforth  Two-Step  method.  The  two  implementations  are  discussed  more  in  depth 
in  the  following  subsections. 

2.2.1. 1  Implementation  on  a  Vertically  Articulated  Robot 

Leahy  and  Whalen  have  implemented  an  AMBC  algorithm,  of  the  type  de¬ 
scribed  above  and  gained  insights  into  issues  such  as  algorithm  tuning,  parameter 
initialization/convergence  and  asynchronous  adaptation  (16).  The  manipulator  used 
was  a  Unimate  PUMA-560  vertically  articulated  robot.  As  described  above,  the 
algorithm  they  implemented  requires  only  desired  values  for  position  and  velocity 
to  control  movement  of  the  robot.  The  control  algorithm  was  then  tested  over  a 
variety  of  trajectories,  using  both  known  and  unknown  payloads.  This  rigorous  test 
scenario  was  designed  to  test  the  algorithm  as  completely  as  possible,  over  the  full 
range  of  manipulator  dynamics.  The  Leahy  and  Whalen  findings  indicate  that  the 
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AMBC  control  algorithm  can  adapt  to  a  given  trajectory  after  a  minimal  number  of 
passes.  In  fact,  peak  trajectory  tracking  errors  were  reduced  by  a  significant  amount 
over  classical  control  methods  [16].  Figure  1.1  is  simply  shown  to  demonstrate  the 
relative  merits  of  a  plain  PD  feedback  controller  versus  an  adaptive  controller.  The 
algorithm  designated  AMBC/H  is  the  heuristically  tuxied  algorithm  developed  by 
Leahy  and  Whalen.  The  designation  AMBC/PBPA  is  the  algorithm  version  that 
will  be  developed  and  discussed  in  later  chapters.  It  can  be  seen  that  both  versions 
of  the  adaptive  feedforward  controller  clearly  provide  better  tracking  accuracy  than 
the  PD  controller  alone.  Furthermore,  they  illustrate  that  both  the  AMBC/H  and 
the  AMBC/PBPA  controllers  provide  essentially  the  same  tracking  accuracy. 

One  interesting  point  of  this  implementation  was  the  method  Leahy  and  Whalen 
used  to  determine  the  initial  values  of  the  linear  parameter  vector  (d).  For  this 
implementation,  d  was  partially  composed  of  an  estimate  of  system  parameters. 
They  note  that  giving  different  initial  values  to  different  parameters,  can  result  in 
convergence  tc  a  minimal  trajectory  tracking  error  in  different  numbers  of  passes 
over  that  particular  trajectory.  Leahy  and  Whalen  note  that  using  the  best  estimate 
of  the  known  physical  values  provides  quicker  tracking  error  convergence  than  does 
starting  d  at  zero. 

Of  more  consequence  to  this  study  are  Leahy  and  Whalen’s  findings  concerning 
Algorithm  tuning.  Through  a  heuristic,  manpower  intensive  process  they  were  able  to 
fine  tune  the  algorithm  to  optimal  performance.  This  ’optimal’  performance  provided 
peak  tracking  error  of  typically  less  than  5  thousandths  of  a  radian  over  the  full  test 
trajectory  suite.  The  persons  performing  this  fine  tuning  procedure  were  well  versed 
in  the  dynamics  of  this  manipulator  -  even  so,  the  tuning  process  was  performed 
gradually  over  the  course  of  months.  The  method  Leahy  and  Whalen  used  to.  tune 
the  algorithm  was  largely  an  iterative  approach,  where  individual  elements  of  F"^ 
were  incrementally  changed.  They  state  that  due  to  the  strong  interdependence 
of  the  parameters,  estimating  them  currently  can  be  as  much  an  art  as  a  science. 
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Figure  2.1.  PD  Only  vs  PD  with  AMBC  -  Trajectory  1 
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Furthermore,  Leahy  and  Whalen  found  that  changing  the  values  could  result  in 
either  improved  performance  or  disaster  [16].  Figure  2.2  is  supplied  as  an  illustration 
of  the  effect  of  setting  F"^  elements  to  a  common  value.  While  it  is  possible  to  track 
the  given  trajectory,  peak  tracking  error  increased  dramatically  over  the  case  v^^here 
a  ’customized’  set  of  F~^  values  were  used. 

2.2. 1.2  Implementation  on  a  Dexterous  Manipulator 

A  Master’s  Thesis,  recently  completed  by  Rainey,  concerned  the  implementa¬ 
tion  and  evaluation  of  an  AMBC  algorithm  on  a  dexterous  manipulator,  configured 
for  two  degrees-of-freedom  [22].  The  robot  used  for  this  study  was  the  Utah/MIT 
Dexterous  Hand  (UMDH).  This  robot  is  a  tendon  driven,  multiple  degree-of-freedom 
hand,  developed  primarily  as  a  research  tool  for  issues  related  to  machine  based  arti¬ 
ficial  dexterity  [11].  The  UMDH  is  a  prime  candidate  for  a  study  of  adaptive  control 
algorithms  because  its  internal  dynamics  are  not  as  well  known  as  the  PUMA’s. 
The  implication  of  this  is  that  any  improvement  in  tracking  accuracy  will  have  been 
caused  by  the  AMBC  algorithm.  Rainey  used  this  robot  to  develop  and  test  an 
AMBC  algorithm  in  terms  of  suitability  for  human  finger  emulation  [22].  As  with 
the  vertically  articulated  robot,  AMBC  provided  a  significant  increase  in  tracking 
accuracy,  as  compared  to  classical  control  methods  [22].  As  did  Leahy  and  Whalen, 
Rainey  also  used  heuristic  methods  to  fine  tune  his  AMBC  algorithm  [16,  22]. 

2.3  Parameter  Reduction 

Once  the  parameters  necessary  for  control  of  the  robot  have  been  determined, 
whether  heuristically  or  mathematically,  an  appropriate  regressor  matrix  can  be  de¬ 
termined  such  that  T  =  Ya.  As  stated  earlier,  in  general,  an  arbitrary  rigid  body 
can  be  described  with  10  dynamic  parameters.  When  two  rigid  bodies  are  connected 
together,  not  all  20  parameters  are  needed  to  describe  the  entire  system  [1, 12,  8].  A 
number  of  papers  have  been  published  which  deal  with  the  issue  of  minimum  param- 
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Figure  2.2.  Effect  of  setting  AMBC/PI  to  a  Common  Value:  Fifth  Run,  Tra¬ 
jectory  1 


eter  identification  and  pararneter  set  reduction.  These  papers  cover  the  spectrum 
from  a  basic  method  to  simply  quantify  the  number  of  necessary  parameters' [8]  to 
another  method  to  determine  w/u’c/i  parameters  are  needed  [4],  to  a  final  inethod 
which  determines  not  only  which  parameters  are  necessary,  but  also  ranks  them  in 
order  of  sensitivity  [5].  These  three  cases  will  be  covered  more  extensively  in  the 
following  sections. 

2.3.1  Base  Parameters  of  Manipulator  Dynamic  Models  As  stated  above, 
while  each  link  of  a  manipulator  has  ten  associated  parameters,  when  a  robotic 
system  of  multiple  links  is  considered,  some  parameters  will  be  redundant.  This  is 
due  to  the  fact  that  the  relative  motion  of  two  adjacent  links  is  restricted  to  one 
degree  of  freedom  and  the  first  link  of  the  manipulator  is  is  typically  connected  to  a 
fixed  base  by  a  joint  [8].  A  parameter  set  consisting  strictly  of  non-redundant  terms 
is  commonly  called  the  base  parameter  set  for  that  particular  manipulator.  Deter¬ 
mination  of  this  base  parameter  set  is  useful  in  reducing  the  on-line  calculations 
needed  for  accurate  control  of  the  robot.  Mayeda  et.al.  have  proposed  a  method  for 
determining  the  minimum  number  of  parameters  for  a  system.  The  equation  they 
arrived  at  is  [8]: 


p  =  7N~  Api  (2.19) 

or,  if  the  first  joint  axis  is  parallel  to  the  gravity  vector: 

p  =  7iV  -  4A  -  2  (2.20) 

where  p  is  the  total  number  of  non-redundant  parameters,  N  is  the  number  of  links 
in  the  manipulator  and  /?i  is  the  number  of  links  connected  by  joints  whose  axes 
are  always  parallel  to  the  first  joint  axis.  This  equation  is  useful  for  determining 
the  quantity  of  parameters  in  the  base  p  .tameter  set;  however,  it  will  not  determine 
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which  parameters  are  important.  This  formula  would  be  useful  to  a  designer  in 
verifying  that  he  has  reduced  the  parameter  set  to  the  correct  size,  but  does  not 
verify  the  accuracy  of  the  reduction  (e.g.  a  non-redundant  parameter  could  possibly 
have  been  eliminated  in  favor  of  a  redundant  parameter). 

2.3.2  Direct  Calculation  of  the  Minimum  Set  of  Inertial  Parameters 

Gautier  and  Khalil  have  also  presented  a  method  for  determining  the  minimal 
set  of  inertial  parameters  for  serial  robots  [4].  Simply  put,  the  procedure  is  to  elimi¬ 
nate  those  parameters  which  have  no  effect  and  to  regroup  the  remaining  parameters 
as  much  as  possible.  To  this  end,  Gautier  and  Khalil  give  a  set  of  rules  which  per¬ 
mit  the  elimination  of  redundant  parameters  and  qualifications  for  regrouping  the 
remaining  parameters.  This  same  method  is  implemented  by  Gautier,  using  a  nu¬ 
merical  approach,  in  an  earlier  paper  [3].  Either  the  Gautier  numerical  approach 
or  the  Gautier/Khalil  rule  based  approach  both  show  promise  of  being  a  straight¬ 
forward  procedure  of  identifying  the  base  parameter  set,  but  unfortunately  do  not 
provide  any  sort  of  element-to-element  relationship  in  the  parameter  vector. 

2.3.3  Principal  Based  Parameter  Analysis 

Even  though  the  methods  described  above  allow  a  AMBC  algorithm  designer  to 
find  the  base  parameter  set,  those  methods  do  not  address  the  relationship  between 
the  individual  elements  of  the  base  parameter  set.  Ghodoussi  and  Nakamura  have 
developed  a  mathematical  method  for  determining  the  base  parameter  set,  ranked 
in  order  of  sensitivity,  which  they  call  Principal  Based  Parameter  Analysis  (PBPA). 
They  present  a  systematic  and  general  method  to  find  those  dynamic  parameters  that 
directly  contribute  to  joint  torques  -  that  is,  the  base  parameter  set  [5].  The  result 
of  this  systematic  analysis  is  a  set  of  parameters  numbered  in  order  of  sensitivity. 
Ghodoussi  and  Nakamura’s  theoretical  development  of  PBPA  is  presented  in  the 
following  sections. 
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2.S.3.1  PBPA  Theoretical  Development  Each  joint  of  a  robot  has  ten 
associated  primitive  dynamic  parameters,  which  describe  hovv  it  is  rnoved  and  posi¬ 
tioned  [20].  These  parameters  are  the  link  mass  m,  the  independent  elements  of  the 
inertia  tensor  Ixz,  lyy,  hz,  hy,  hz,  lyz  and  the  three  position  elements  of  the  mass 
centroid,  rx)  Vy,  [5].  When  moving  the  end  effector  into  some  arbitrary  position, 
some  of  these  parameters  are  more  important  than  others  and  some  parameters  will 
be  redundant.  Through  exhaustive  testing,  or  with  some  insight  into  a  particular 
manipulator,  a  reduced  parameter  set  can  be  found.  This  reduced  parameter  set  al¬ 
lows  for  the  same  total  joint  torque  to  be  found,  with  less  computation.  The  method 
presented  by  Ghodoussi  and  Nakamura  not  only  identifies  the  minimal  parameters 
specifically,  but  may  also  answer  the  more  important  question  of  how  to  fine  tune 
an  AMBC  algorithm.  The  equations  developed  by  Ghodoussi  and  Nakamura  are 
presented  in  the  following  section. 

2.3.4  Development  of  PBPA  Equations  The  torque  equations  for  a  manipu¬ 
lator  can  be  represented  in  the  form  [6]: 


T  =  N(q,q,q)p 


(2.21) 


where  p  is  the  complete  parameter  vector  and  N  is  defined  as: 


N{q,(hq)  = 


\ 


,  where  n,-  €  .  (2.22) 


/ 


T^liqAA) 

The  n  subscript  denotes  total  number  of  joints,  n,-  can  be  further  defined  as 


ni{qAA)  =  ^o{qAA)Ki 


(2.23) 
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Where  no  is  defined  as  a  vector  containing?all  the  riori-linear  termsithat  appear 
in  N  and  Ki  is  a  constant  matrix  involving  the  kinema.tic  paraiiieters  for  link  i. 

N  can  now  be  represented  as: 


N  = 


V 


(2.24) 


Next,  a  variation  in  torque  due  to  a  variation  in  the  parameter  set  can  be 
represented  as: 


8t  =  N{q,q,q)8p 


(2.25) 


and 


J{8r>)  =  J  ...  j  ll^r  f  %  . . .  dqmdqi . . .  dq^dq\  ...dq^  (2.26) 


Combining  the  above  equations,  yields 


J{Sp)  =  Sp'^(^K,  ...  K^) 


^  R  ...  o  '' 


y  0  ...  R  j 


I  \ 


8p  (2.27) 


where 


R 


=  ln,nl<lV 


(2.28) 
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R  is  a  symmetric,  positive  semidefinite  matrix  and  is  called  the  Covariance 
Matrix  of  Nonlinearity.  A  symmetric,  positive  semi-  definite  matrix  can  be  shown 
in  the  form  R  =  RR^  where  R}!"^  =  R.  Substituting  back  into  equation  2.27; 

J{6p)  =  S/S^SSp  (2.29) 

where 

S=  ^ 

,  R^'^Kl  J 

Equation  2.30  implies  that  the  nonlinear  effect  of  5,  q  and  q  on  the  contribution 
of  the  dynamic  parameters  to  joint  torques  is  taken  into  account  via  the  covariance 
matrix  of  nonlinearity. 

The  Singular  Value  Decomposition  of  I  is: 

SVD{S)  =  (2.31) 

and  the  Principal  Base  Parameters  (denoted  p*)  are  simply  found  by: 

p-  =  V/p=W  •••-?«/  (2-32) 


Vi 


(2.33) 


The  end  result  of  PBPA  is  this  reduced  linear  parameter  vector  p*,  which  has 
an  inherent  relationship  between  its  elements.  This  relationship  will  be  exploited  in 
the  following  chapter  to  develop  a  simple  AMBC  tuning  procedure. 
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2-4  Conclusion 

Adaptive  Coclrol  will  play  0  large  part  in  the  future  of  robotics.  AMBC  provides 
a  tremendous  improvement  in  tracking  accuracy  over  plain  ;PD  controllers;  however, 
the  associated,  heuristic  tuning  process  has  kept  AMBC  from  transitioning  from 
the  laboratory  environment  to  operational  applications.  Before  AMBC  can  become 
widely  used  in  everyday  operations,  some  straightforward  procedure  for  algorithm, 
tuning  must  be  found.  Furthermore,  this  tuning  procedure  should  not  require  a 
huge  inv'^stment  of  manpower  or  extensive  knowledge  of  the  system  dynamics.  To 
date,  no  such  procedure  exists,  even  though  at  least  one  possible  approach  has  been 
suggested.  This  study  will  explore  the  possibility  of  developing  an  AMBC  algorithm 
and  an  associated  procedure  that  details  how  to  quickly  and  simply  tune  for  optimal 
performance. 
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III.  Adaptive  Model-Based  Control  Development  using  Principdl 

Base  Parameter  Analysis 

3.1  Overview 

Previous  studies  at  the  Air  Force  Institute  of  Technology  have  shown  that  Adap-, 
tive  Model-Based  Control  (AMBC)  algorithms  can  provide  excellent  tracking  accu¬ 
racy  as  compared  to  classical  control  methods  [16,  22].  One  of  the  reasons  AMBC 
algorithms  are  not  more  widely  used  in  operational  systems  is  the  method  by  which 
they  must  be  fine  tuned  for  optimal  performance.  This  tuning  process  is  currently 
heuristic  and  manpower  intensive  in  nature.  Before  AMBC  algorithms  can  gain 
wider  acceptance  outside  of  laboratory  environments,  the  tuning  process  must  ma¬ 
ture  considerably. 

As  discussed  in  the  previous  chapter,  a  method  of  parameter  analysis  recently 
proposed  by  Ghodoussi  and  Nakamura  may  provide  a  basis  for  a  more  acceptable 
tuning  process.  Their  analysis  method,  Principal  Base  Parameter  Analysis  (PBPA), 
might  be  used  in  a  process  by  which  an  AMBC  algorithm  can  be  tuned  in  minutes 
vice  the  current  tuning  time  of  hours  or  days. 

This  chapter  will  use  PBPA  to  develop  an  AMBC  algorithm  which  can  be  tuned 
with  a  single  scaling  factor.  This  development  process  will  first  be  illustrated  with 
a  planar,  two  degree  of  freedom  example.  The  procedure  will  then  be  applied  to 
the  PUMA-560,  configured  as  a  three  degree  of  freedom  platform  (joints  one,  two 
and  three  actuated).  Finally,  the  possibility  of  extending  this  analysis  to  a  second 
manipulator,  the  Utah/MIT  Dexterous  Hand  will  be  discussed. 

3.2  AMBC  Design  with  PBPA 

Numerous  forms  of  Adaptive  Model-Based  Control  have  been  proposed  and 
experimentally  evaluated.  The  direct  adaptive  forms  share  the  following  general 
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format: 


T  =  y{q,q,q)a  +  Tfb  (3.1) 

T 

a=  I  r-'Y'^(q,q,q)s  (3.2) 

Jo 

where  tji,  represents  a  linear  feedback  law  and  s  is  a  vector  of  weighted  tracking 
error.  Two  universal  design  considerations  are  the  size  and  physical  representa¬ 
tion  of  the  regressor  (T)  and  the  method  of  tuning  the  adaptive  gain  matrix 
While  multiple  combinations  of  Y  and  a  can  produce  identical  joint  torques,  different 
permutations  of  Y  and  a  result  in  variations  in  algorithm  stability,  computational 
complexity,  and  tracking  performance  [16].  The  dependence  of  algorithm  stability, 
parameter  convergence,  and  tracking  performance  on  the  strength  of  the  F"^  ele¬ 
ments  is  also  well  known.  As  discussed  in  section  2.2.1. 1,  the  current  method  of 
determining  the  strength  of  the  individual  F~^  elernents  is  by  trial  and  error.  This 
heuristic  tuning  process  is  time  consuming  and  provides  no  indication  of  the  ’best’ 
set  of  F“^  values.  AMBC  design  using  PBPA  may  provide  a  non-heuristic  basis  for 
tuning  the  F“^  elements.  To  illustrate  this  proposed  design  procedure,  the  linear 
parameter  vector  (d),  the  regressor  matrix  and  the  adaptive  gain  matrix  values  are 
first  determined  for  a  2  DOF  ideal  planar  arm  representation,  based  on  links  2  and 
3  of  a  PUMA-’  60.  The  extension  of  that  procedure  to  a  real  3  DOF  PUMA  configu¬ 
ration  is  then  discussed.  Finally,  the  foundation  for  extension  of  this  process  to  the 
Utah/MIT  Dexterous  Hand  is  laid. 

S.2.1  Ideal  2  DOF  PUMA 

Using  standard  Denavit-Hartenberg  convention,  the  link  parameter  notation 
used  by  Spong  and  Vidyasagar,  and  for  the  moment  neglecting  drive  system  dynam¬ 
ics,  the  torque  equations  for  joints  2  and  3  are  written  as  [13,  26): 


■^2  —  ?2(  ^2  +  J3  +  ^c2^2  +  +  ^hlcu^^z  sin  (73) 
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+  +  4^c3^3  sin  (73) 

+  ‘^q2^zhl<^rnz  cos  qz 
+  qlhlczmz  cos  qz 

-  glc^mz  cos  qz 

-  ghmz  cos  <72 

-  gU^z  sin(?2  +  93) 

73  =  92(^3  +  ^^W73  +  y^mz  sin  93) 

+  h{Jz  + 

+  qlklczrnz  cos  <73 
-9^c37n3sin(92  +  93) 

For  this  simple  example,  the  nonlinear  terms  are  grouped  into  the  no- vector  by 
inspection,  yielding: 


=  [  92  -fa  sin  93  93  93  sin  93  cos  939293 
cos  9393  cos  92  sin(92  +  93)  cos  qzql  ] 

with  the  corresponding  vector  of  all  primitive  parameters  giveii  by: 


(3.3) 


=  [  J2  Jz  rnzlcz  Tns/f  mzhz^ 
mzhzh  mzlczg  ”13/29  ruzlczg  ] 


and  the  constant  matricies  Ki  defined  as: 


Ki 


’1  1  1  1  1  0  0  0  0 

000002  0  0  0 

010010  0  0  0 

OOOOICO  0  0 

000002  0  0  0 

000001  0  0  0 

000000  -1  -1  0 

0000020  0-1 
.0  00000  0  0  0 


(3.4) 


(3.5) 
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K2  = 


'0  1 
0  0 
0  1 
0  0 
0  0 
0  0 
0  0 
0  0 
0  0 


0  0  1  0  0  0 
0  0  0  1  0  0 
0  0  1  0  0  0 
0  0  0  0  0  0 
0  0  0  0  0  0 
0  0  0  0  0  0 
0  0  0  0  0  0 
0  0  0  0  0  0 
0  0  0  1  0  0 


0 

0 

0 

0 

0 

0 

0 

-1 

0 


(3.6) 


The  Covariance  Matrix  of  Nonlinearity  is  calculated  by  Equations  2.28,  3.3,  and 
an  appropriate  set  of  integration  limits  on  l^],  1^1,  and  j^j.  The  \^alues  chosen  for  the 
integration  limits  are  configuration  specific.  For  this  particular  configuration,  the 
values  |<jr,|  <  ff,  \qi\  <  2,  |^,-|  <  5  were  chosen.  These  particular  values  define  the 
experimentally  determined  maximums  for  a  PUMA  robot  [18).  Symmetrical  limits, 
while  not  truly  indicative  of  most  industrial  robots,  significantly  reduce  the  overall 
complexity  of  the  PBPA.  If  non-symmetrical  limits  are  used,  the  R  matrix  is  less 
sparse,  therefore  complicating  the  results.  Simplification  via  symmetrical  integration 
limits  becomes  pivotal  with  higher  degree  of  freedom  cases  (3  DQF  and  more).  In 
fact,  when  the  3  DOF  case  was  first  investigated,  real-world  values  were  used  for  the 
integration  [13].  The  overall  integration  for  non-symmetrical  limits  took  almost  10 
times  longer  than  when  symmetrical  limits  were  used. 

Forming  S  (Equation  2.30)  and  performing  a  Singular  Value  Decomposition 
yields  Vj  and  therefore,  the  Principal  Base  Parameter  Set,  p*.  (Equations  2.31  and 
2.32). 


p*  = 


-0.2182(  h  -h  /g27n2  -b  llrriz)  -  0.6547(J3  -f  /^ms) 
— 0..53'15(  J2  +  I^m2  +  /fms)  -f-  0.2673(J3  -b  /^ms) 
0.02486(<7/c2m2  -b  ghm^  — 

—0.7067(^/(27712  -b  glims)  —  0.03516/2/(37713 
-glcsmz 


3.2.1. 1  Formulalion  of  llic  Adaptation  Control  Law 
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As  discussed  in  section  3.2,  the  general  form  of  a  direct  adaptive  controller  is 
r  =  Y{q,  5,  q)a  +  Tjb.  Feedforward  torque  is  simply  the  product  of  the  regressor 
matrix  Y  and  a  linear  parameter  vector  d.  Since  p*  has  been  defined  as  the  set  of 
non- redundant  parameters,  for  this  design  procedure,  set  a  =  p*.  For  this  design 
example,  the  next  piece  of  the  puzzle  is  to  find  Y.  It  is  useful  to  explicitly  point  out 
that  Y  is  not  unique.  The  exact  composition  of  Y  depends  on  the  system  torque 
equations  and  the  final  make-up  of  the  linear  parameter  vector. 

The  size  of  p*  implies  that  the  regressor  will  be  a  2  X  5  matrix  (e.g.  2  joints 
X  5  p*  elements).  The  next  step  is  to  determine  the  actual  regressor  values.  The 
terms  in  the  regressor  matrix  can  be  determined  using  knowledge  of  the  system 
torque  equations  =md  p*,  to  solve  a  series  of  simultaneous  equations.  A  symbolic 
mathematic  manipulator,  such  as  ’’Mathematica”  [28]  minimizes  the  drudgery.  For 
For  the  2  DOF  case,  the  system  of  equations  was  9  equations  with  9  unknowns.  The 
value  nine  is  simply  the  number  of  discrete,  non-linear  terms  appearing  in  n^.  The 
size  of  nj  for  the  3  DOF  case  implies  a  system  of  equations  of  54  equations  with  54 
unknowns.  This  indicates  that  larger  DOF  manipulators  will  quickly  become  quite 
complex  and  their  regressor  increasingly  more  difficult  to  find  -  perhaps  impossible 
to  find  without  computer  aid.  It  should  be  noted  that  finding  the  regressor  matrix 
via  simultaneous  equations  is  straightforward,  but  time  consuming.  The  result  of 
the  simultaneous  equations  for  the  2  DOF  equation  is  shown  as  Equation  3.7. 


-0.654752  -  1.3093(52  -f  53) 

—1.603652  0.5345(52  -f  53) 

—0.0498  cos  52  —  0.99938(25253  cos  53  +  53  cos  53  -f  252  sin  53  -t-  53  sin  53) 
1.4133 COS52  ■+•  0.03516(— 25253 cos 53  -  53 cos 53  -  252.<’in53  -  qssinqa) 

sin(52  53) 


-1.3093(52 -k  53) 
0.5345(52  +  53) 
-0.99938(52  cos  53  -k  52  sin  53) 
—0.03516(52  cos  53  +  52  sin  53) 
sin(52  -t-  53) 


(3.7) 
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3.2. 1.2  Tuning  the  AMBC  Algorithm 


is  a  diagonal  adaptive  gain  matrix  whose  values  control  the  rate  of  adap¬ 
tion  of  the  individual  a  parameters.  As  discussed  in  section  2.3. 3.1,  Principal  Base 
Parameter  Analysis  not  only  eliminates  all  redundant  parameters  yielding  the  base 
parameter  set,  but  also  ranks  the  base  parameter  set  elements  in  order  of  sensitiv¬ 
ity.  This  relative  ordering  of  the  individual  parameter  set  elements  is  what  provides 
the  basis  for  non-heuristic  tuning  of  the  AMBC  algorithm.  The  elements  of  a  (post 
PBPA)  have  an  inherent  relationship  to  one  another,  and  there  is  an  element  to 
element  correspondence  between  a  and  F'^ .  Therefore,  F“^  should  possess  the  same 
type  of  relationship  among  it’s  elements. 

The  physical  values  for  the  inertial  parameters  (e.g.  link  lengths,  masses,  etc.) 
are  now  substituted  into  a.  The  resultant  is  a  numerical  vector  and  is  used  as 
the  diagonal  base  value  for  F~^.  Assuming  that  the  magnitudes  of  the  individual 
parameters  are  a  valid  indication  of  their  relative  impact  on  controller  torque,  and 
therefore  tracking  performance,  tuning  is  reduced  to  varying  the  entire  F“^  matrix  by 
a  scaling  factor,  as  opposed  to  tuning  individual  elements.  Determining  the  validity 
of  that  assumption  is  the  objective  of  the  experimental  analysis.  However,  before  this 
analysis  can  take  place,  p*  and  the  associated  regressor  for  the  three  DOF  PUMA 
must  be  determined. 

3.2.2  The  Three  DOF  Case 

In  order  to  conduct  a  realistic  evaluation  of  incorporating  PBPA  into  AMBC 
design,  the  two  DOF  procedure  was  extended  to  the  three  positioning  links  of  the 
PUMA.  The  lengths  of  the  equations  make  their  inclusion  at  this  point  in  the  paper 
unrealistic  ,  however,  they  can  be  found  in  the  appendices.  The  starting  point  was  to 
determine  the  primitive  parameter  vector  that  represented  all  the  classical  dynamics 
of  these  three  links  of  the  manipulator.  As  for  the  two  DOF  case,  the  first  step  in 
this  design  procedure  was  to  take  the  torque  equations  and  re-arrange  them  into  the 
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form  shown  in  Equation  2.21.  This  re-arrangement  resulted  in  a  primitive  parameter 
vector  (nj)  of  all  of  the  dynamic  parameters,  but  excluding  friction.  Followirig 
the  same  steps  as  detailed  for  the  two  DOF  case,  PBPA  produced  an  18  element 
principal  base  parameter  vector  (p*).  A  realistic  dynamical  representation  of  the 
PUMA  must  also  incorporate  drive  system  information.  Previous  studies  indicate 
that  inclusion  of  coulombic  and  viscous  friction  torques  in  each  joint  is  sufficient 
[18,  24].  Since  the  linear  coefficients  of  those  forces  are  independent  of  inertial 
dynamics,  they  can  simply  be  appended  onto  the  nominal  p*  vector.  Including 
them  in  the  primitive  parameter  vector  would  only  have  complicated  the  PBPA  and 
would  have  contributed  no  additional  information.  Initial  attempts  at  PBPA  for 
the  three  DOF  case  included  the  friction  terms  in  the  primitive  parameter  vector 
and  they  remained  intact  (e.g.  they  were  not  reduced  further)  by  PBPA.  All  of  this 
considered,  the  six  friction  parameters  increases  the  size  of  the  complete  principal 
base  parameter  vector  to  24  elements. 

Once  the  complete  p*  vector  was  found,  physical  values  for  the  variables  (e.g. 
masses,  link  lengths,  experimentally  determined  friction  coefficients,  etc.)  were  sub¬ 
stituted  and  the  individual  p*  elements  were  re-arranged  in  decreasing  order  of  their 
absolute  magnitude,  p*  was  next  normalized  to  the  magnitude  of  its  smallest  element. 
The  final  product  was  a  linear  parameter  vector,  consisting  of  24  elements,  made  up 
of  the  minimal  required  inertial  parameters,  as  well  as  the  viscous  and  coulombic 
friction  parameters,  arranged  in  decreasing  order  of  relative  absolute  magnitude  and 
normalized  to  the  smallest  relative  value.  This  normalized  p*,  rounded  to  the  near¬ 
est  whole  number,  is  8530,  2896,  2254,  2043,  1782,  1348,  1171,  1048,  1048,  448,  396, 
386,  329,  204,  185,  137,  99,  71,  64,  35,  9,  4,  3,  1.  In  the  actual  implementation, 
greater  precision  was  used  -  the  rounding  done  here  was  applied  simply  to  illustrate 
the  relative  values. 

Finally,  as  described  in  the  previous  section,  the  regressor  was  found  using  the 
initial  torque  equations  and  a  system  of  simultaneous  equations,  solved  via  Mathe- 
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matica  on  a  Sparc2  workstation.  Using  a  comparable  machine  and  given  the  torque 
equations  and  integration  limits,  a  user  experienced  in  both  PBPA  and  Mathemat- 
ica  could  arrive  at  a  final  p*,  for  a  typical  three  DOF  manipulator,  in  under  one 
day.  This  process  is  somewhat  time-consuming,  however,  the  inconvenience  should 
be  traded  off  against  the  relative  resultant  ease  of  tuning  after  implementation. 

3.3  The  Utah/MIT  Dexterous  Hand  Implementation 

Using  the  same  torque  equations  cis  Rainey,  and  following  the  design  steps 
laid  out  above,  PBPA  was  done  on  the  UMDH,  configured  as  a  two  degree  of  free¬ 
dom  manipulator.  Furthermore,  the  results  of  the  PBPA  were  incorporated  into 
an  AMBC  algorithm;  however,  work  was  halted  just  short  of  implementation.  As 
discussed  in  chapter  2,  there  was  significant  effort  to  be  expended  on  making  the 
UMDH  operational,  before  the  AMBC/PBPA  experimental  analysis  could  be  done. 
Unfortunately,  this  extra  effort  caused  this  part  of  the  research  to  be  aborted.  At 
time  of  publication,  the  host  computer  for  the  ARCADE  software  was  only  able  to 
achieve  rudimentary  communication  with  the  UMDH.  This  interface  was  not  enough 
to  implement  and  evaluate  any  sort  of  advanced  control  algorithms.  Consequently, 
no  analysis  of  results  for  the  UMDH  will  be  discussed  in  chapter  4. 

3.4  Summary 

A  procedure  for  the  design  of  an  non-heuristically  tuneable  adaptive  controller 
was  developed  by  way  of  a  tv'o  degree  of  freedom  planar  example.  This  two  DOF 
example,  based  on  joints  two  and  three  of  the  PUMA  560  used  the  original  torque 
equations  to  perform  Principal  Base  Parameter  Analysis.  The  resultant  principal 
base  parameter  vector  was  then  used  to  find  an  AMBC  regressor  matrix  and  corre¬ 
sponding  base  values.  Finally,  this  two  DOF  example  was  extended  to  the  three 
positioning  links  of  the  PUMA  560.  Some  of  the  pitfalls  of  the  approach  (i.e.  se¬ 
lection  of  integration  limits,  exponential  growth  of  the  simultaneous  equation)  were 
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also  discussed.  The  next  logical  step  in  this  study  is  to  actually  implement  the  3 
DOF  AMBC/PBPA  controller  and  contrast  its  performance  against  the  performance 
achieved  with  the  heuristically  reduced  and  tuned  controller. 
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IV.  PBPA  Test  and  Analysis 


^.1  Overview 

The  true  test  of  the  potential  of  an  advanced  control  algorithm  can  only  be 
determined  via  experimental  test  and  evaluation.  To  that  end,  the  AMBC/PBPA  al¬ 
gorithm  heis  been  exhaustively  tested  and  the  results  analyzed.  The  goal  of  these  ex¬ 
perimental  evaluations  was  to  validate  concepts,  not  to  produce  the  optimal  PUMA- 
specilic  algorithm.  Therefore  all  test  runs  produced  using  the  AMBC/PBPA  algo¬ 
rithm  had  the  same,  single  P"^  scaling  factor.  No  attempt  was  made  to  ’fine-tune’ 
the  AMBC/PBPA  algorithm  further.  This  restraint  from  fine  tuning  is  important 
because  these  results  are  to  be  compared  against  the  AMBC/H  algorithm  which 
was  fine  tuned  over  the  course  of  months.  The  initial  thrust  of  this  chapter  is  to 
describe  the  test  environment  and  algorithm  initialization  issues,  followed  by  a  de¬ 
scription  of  the  test  trajectories.  The  test  suite  follows  that  made  in  past  AFIT 
studies  [14, 15, 16, 17, 18].  The  AMBC/PBPA  algorithm  will  be  compared  and  con¬ 
trasted  against  the  AMBC/H  algorithm  in  areas  such  as  simple  trajectory  tracking, 
robustness  to  payload  variation,  parameter  convergence,  pattern  learning  and  sensi¬ 
tivity  to  reduction  of  parameters.  The  two  algorithms  will  be  compared  numerically, 
as  well  as  graphically.  In  this  chapter,  only  representative  plots  will  be  shown  -  the 
comprehensive  collection  of  plots  can  be  found  in  the  appendices. 

4-8  Test  Environment 

Principal  Base  Parameter  Analysis  is  an  avenue  that  can  be  used  by  an  AMBC 
designer  to  come  up  with  an  easily  tuned  control  algorithm.  However,  does  this 
algorithm  provide  adequate  tracking  accuracy?  This  experimental  evaluation  will 
compare  the  AMBC/PBPA  algorithm  against  the  AMBC/H  algorithm,  as  used  in 
previous  AFIT  studies.  The  ultimate  goal  is  to  determine  if  PBPA  provides  a  sound 
basis  for  tuning  the  adaptation  gain  matrix  of  an  AMBC  algorithm  with  a  single 
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scaling  factor.  Furthermore,  it  is  to  show  the  ability  to  reduce  the  required  set  of  pa¬ 
rameters  needed  by  an  adaptive  algorithm,  without  introducing  significant  additional 
tracking  errors. 

The  algorithm  chosen  to  accomplish  this  is  the  Sadegh  and  Horowitz  version  of 
an  adaptive  controller,  which  has  been  used  in  previous  AFIT  studies  [23,  22,  16]. 
This  Desired  Compensation  Adaptation  Law  (DCAL)  was  discussed  in  depth  in 
section  2.2.1.  The  PD  gains  were  set  to  stiff  values  employed  in  previous  model 
based  studies  [18,  16]  and  reiterated  in  table  4.1. 


Table  4.1.  Stiff  PD  Feedback  Gains 


Joint  1 

Joint  2 

Joint  3 

640.0 

1330.0 

360.0 

Kv 

72.0 

130.0 

25.0 

The  same  form  of  the  DCAL  was  used  for  both  cases;  that  is,  for  the  heuris- 
tically  tuned  case  (ala  Leahy  and  Whalen)  and  for  the  non-heuristically  tuned  case 
(this  study).  While  the  same  same  form  is  used  (e.g.  T//  =  Fa),  is  should  be  noted 
that  both  F  and  a  will  be  composed  of  entirely  different  values.  As  described  in  sec¬ 
tion  2.2. 1.1  these  two  cases  will  be  referred  to  as  ’AMBC/H’  and  ’AMBC/PBPA’, 
respectively  (AMBC/H  meaning  AMBC  with  heuristic  tuning).  Finally,  these  ex¬ 
perimental  evaluations  were  conducted  at  a  servo  rate  of  222  Hertz,  using  the  AFIT 
Robotic  Control  Algorithm  Development  and  Evaluation  (ARCADE)  environment 
[18]. 


4.2.1  Description  of  Trajectories  The  test  trajectories  chosen  correspond  to 
those  used  by  Leahy  and  Whalen  for  their  analysis  of  a  Direct  Adaptive  Controller 
for  Industrial  Manipulators  [16].  Their  results  will  be  used  as  a  benchmark  for 
comparison.  The  chosen  trajectories,  listed  in  Table  4.2,  were  first  performed  under 
zero  payload  conditions.  Next,  to  prove  adaptability  under  loaded  conditions,  two  of 
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the  trajectories  were  also  run  with  a  2  Kg  brass  disk  attached  to  the  link  six  mounting 
flange  [16].  Motor  saturation  constraints  limited  payload  testing  to  Trajectories  1 
and  3  only. 


Table  4.2.  Test  Trajectories  (degrees)  [16] 


Number 

Start 

Finish 

Time  (sec) 

1 

-50,-135,135 

45,-90,30 

1.5 

2 

-50,-205p 

45,-160,-15 

2.0 

3 

0,-180,180 

95,-135,75 

2.0 

4 

0,-90,90 

-95,-135,-15 

2.0 

5 

0,-45,135 

-95,-90,20 

2.0 

6 

0,-90,90 

95,-135,195 

1.5 

Trajectories  1,  2,  and  3  each  have  an  angular  movement  of  (95°, 45°, —105°). 
Trajectory  1  and  Trajectory  6  both  travel  the  trajectory  in  1.5  seconds  while  Tra¬ 
jectories  2  -  5  are  performed  in  2.0  seconds.  The  desired  trajectory  velocity  and 
acceleration  components  will  be  identical  for  Trajectories  2  and  3.  Trajectories  4 
and  5  apply  identically'generated  trajectory  commands  to  different  initial  conditions. 
When  compared  to  Trajectories  2  and  3,  the  initial  positions  differ  and  the  move¬ 
ment  of  Joints  1  and  2  is  opposite.  (Trajectories  4  and  5  move  (—95°,  —45°,  —105°)). 
The  respective  desired  position  and  acceleration  terms  should  also  differ  in  sign  from 
those  of  Trajectories  2  and  3.  These  two  test  trajectories  permit  testing  to  consider 
the  effects  of  different  starting  positions  and  direction  of  motion. 

The  movement  of  Trajectory  6  is  similar  to  Trajectory  1.  Joint  3  moves  in  the 
opposite  direction  while  Joint  1  and  2  movement  is  the  same.  Desired  velocity  and 
acceleration  terms  for  Joint  3  should  have  opposite  signs.  This  trajectory  can  be 
used  to  determine  the  effects  of  different  starting  positions,  direction  of  motion,  and 
trajectory  speed  [24].  This  selection  of  trajectories  will  allow  evaluation  of  the  effects 
of  different  starting  positions  and  trajectory  speeds. 
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4.2.2  Initialization  of  a 

To  be  consistent  with  Leahy  and  Whalen’s  testing,  only  16  estimated  parameters 
were  used  by  the  DCAL.  While  Leahy  and  Whalen  chose  16  parameters  based  on  pay- 
load  sensitivity  analysis,  the  16  parameters  chosen  for  the  AMBC/PBPA  algorithm 
were  simply  the  16  most  sensitive  parameters  (as  indicated  by  the  Principal  Base 
Parameter  Analysis).  The  remaining,  non-estimated  parameters  were  given  their 
nominal  physical  values.  Leahy  and  Whalen  have  determined  that  16  parameters  ri¬ 
valed  the  tracking  performance  of  their  robust  feedback  algorithm,  while  expanding 
the  a  vector  beyond  16  elements  produced  a  negligible  effect  on  tracking  accuracy 
[16].  This  inference  is  consistant  with  AMBC/PBPA  -  refering  to  the  values  given 
for  the  normalized  p*  (section  3.2.2),  it  can  be  seen  that  p*(17)  is  approximately 
two  orders  of  magnitude  less  than  p*(l).  Consequently,  the  inclustion  of  parameters 
17-24  in  the  adaptation  process  would  provide  a  .-ery  small  additional  feedforward 
torque  in  comparison  to  parameters  1-16. 

One  other  point  should  be  explicitly  made  concerning  the  non-estimated  pa¬ 
rameters.  To  reiterate,  the  total  size  of  the  AMBC/H  parameter  vector  is  28  el¬ 
ements;  total  size  of  the  AMBC/PBPA  parameter  vector  is  24  elements  (refer  to 
section  3.2.2).  This  implies  that  there  are  12  and  8  non-estimated  parameters  for 
the  AMBC/H  and  the  AMBC/PBPA  algortihms,  respectively.  The  non-estimated 
elements  of  each  parameter  vector  are  given  their  nominal  physical  values  and  remain 
constant  throughout  the  entire  trajectory  (e.g.  do  not  adapt).  These  non-estimated 
parameters  contribute  to  the  feedforward  torque  as  shown  in  Equation  2-10. 

4.2.2. 1  A  MB  C/ H  Initialization  of  a 

For  all  cases  where  the  AMBC/H  algorithm  was  utilized,  a  was  initialized  to  its 
approximate  physical  values,  as  given  by  Tarn  and  Bejczy  [27].  This  initialization  of 
a  causes  the  trajectory  error  to  be  significantly  lower  in  the  first  run,  as  opposed  to 
initially  setting  a  to  zero  [16].  These  physical  values  are  used  simply  as  an  approxi- 
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mation  to  what  the  values  should  be;  the  adaptive  controller  will  finedune  them  to 
more  appropriate  values  during  the  course  of  the  adaption. 

4.S.2.2  AMBG/PBPA  Initialization  of  a 

For  the  cases  where  the  AMBC/PBPA  algorithm  v;as  used,  a  was  initialized 
to  a  pre-determined  set  of  values.  This  pre-determined  set  of  values  was  found  by 
running  Trajectory  2  until  steady  state  error  occurred.  This  particular  set  of  values 
was  chosen  because  Trajectory  2  was  arbitrarily  decided  to  be  the  most  ’benign’  of 
all  the  trajectories.  C.  ’sequently,  initial  runs  on  this  trajectory  were  less  likely  to 
become  unstable  while  the  algorithm  was  tuned  (via  the  adaptive  gain  matrix  scale 
factor).  The  resultant  a  values  were  then  used  as  the  initial  a  values  on  all  other 
trajectories  (Table  4.3).  At  first,  the  AMBC/PBPA  a  initialization  was  attempted 
in  the  same  manner  as  the  AMBC/H  a  initialization  -  that  is,  the  values  were  set 
to  their  approximate  physical  values.  However,  using  this  approach,  the  PUMA  was 
unable  to  successfully  track  a  subset  of  the  test  trajectories.  This  seems  to  indicate 
that  one  (or  more)  of  the  approximations  used  is  (are)  grossly  out  of  line. 

4.2.3  Values 

A  prime  advantage  of  PBPA  can  now  be  shown.  Referring  to  Equation  2.15, 

is  a  diagonal  matrix,  used  to  tune  the  relative  contribution  of  each  individual 
element  of  the  linear  parameter  vector  to  the  overall  feedforward  torque.  Leahy 
and  Whalen  note  that  with  their  previous  method  of  reducing  the  parameter  vec¬ 
tor  through  experimentation,  the  matrix  must  also  be  tuned  heuristically  [16]. 
As  discussed  in  section  2.2.1. 1,  while  it  is  possible  with  the  AMBC/H  algorithm 
to  simply  set  each  element  of  to  a  common  value,  if  the  value  chosen  is  too 
large,  tracking  accuracy  suffers,  if  the  value  chosen  is  too  small,  adaptation  time 
increases.  The  Leahy/Whalen  method  was  to  iteratively  tune  each  element,  seeking 
best  overall  performance.  Leahy  and  Whalen  were  able  to  achieve  admirable  track¬ 
ing  accuracy,  but  at  the  expense  of  tuning  the  algorithm  over  the  course  of  months. 
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With  AMBC/PBPA,  the  adaptive  gain  matrix  (section  3.2.2)  can  be  tuned  as  a 
whole  because  each  element  is  relative  to  the  others.  To  change  the  rate  of  adapta¬ 
tion  of  the  system,  the  entire  AMBC/PBPA  would  simply  need  to  be  multiplied 
by  a  different  scaling  factor;  however,  the  AMBC/H  would  need  to  be  manually 
re-tuned,  element  by  element.  For  all  testing,  the  P~^  values  used  for  the  AMBC/H 
algorithm  are  (120,120,120,0,90,90,90,15,150,5,80,30,15,80,80,80)  [16].  The  P-^  val¬ 
ues  for  the  AMBC/PBPA  version  of  the  algorithm  are  the  normalized  values  of  the 
p*  vector  (section  3.2.2),  scaled  by  the  multiple  0.020.  The  value  0.020  was  chosen 
because  it  was  the  maximum  scaling  factor  with  which  tracking  was  possible  over  all 
six  trajectories.  Incidently,  approximately  1  hour  was  consumed  settling  on  this  par¬ 
ticular  scale  factor.  The  time  spent  tuning  the  AMBC/PBPA  algorithm  compares 
favorably  to  the  months  spent  tuning  the  AMBC/H  algorithm.  If  it  were  desired 
to  increase  the  amount  of  feedforward  torque  to  the  system  (therefore  decreasing 
the  time  to  steady  state  error),  it  would  simply  be  a  matter  of  increasing  the  single 
scaling  factor;  however,  it  should  be  noted  that  increasing  the  scale  factor  may  cause 
instability  on  one  or  more  of  the  test  trajectories. 

4-3  Analysis  of  Data 

4.3.1  Evaluation  Over  Standard  Trajectories  This  series  of  figures  (Figures 
4. 1-4.5)  demonstrates  the  performance  of  both  algorithms  showing  selected  trajec¬ 
tories  and  joints,  no  payload.  Each  figure  shows  the  first  and  fifth  pass  of  each 
version  of  the  adaptive  controller  over  the  noted  trajectory.  Most  of  the  figures  have 
a  common  thread:  the  AMBC/PBPA  algorithm  starts  with  a  slightly  larger  track¬ 
ing  error  and  still  has  not  caught  the  AMBC/H  algorithm  by  the  fifth  pass.  In  fact, 
this  trend  continues;  that  is,  the  AMBC/H  algorithm  consistently  shows  a  tracking 
error  somewhat  less  than  the  AMBC/PBPA  algorithm  (Figure  4.6);  furthermore, 
the  performance  of  the  two  algorithms  never  converge.  However,  it  should  be  noted 
that  the  difference  in  tracking  error  is  normally  in  the  area  of  a  few  thousandths  of 
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a  radians.  Regardless,  the  AMBC/PBPA  algorithm  essentially  reaches  steady  state- 
error  after  approximately  five  passes  (as  does  the  AMBC/H' algorithm). 

4.3.S  Adaption  of  a 

Table  4.3  shows  the  final  values  of  the  AMBC/PBPA  a  for  selected  trajectories. 
They  are  seen  to  be  quite  different  from  their  best  estimate  physical  values;  however, 
the  steady  state  values  are  in  the  same  realm  over  completely  different  trajectories. 
This  is  the  one  area  where  heuristics  have  not  been  completely  eliminated.  As 
described  in  section  4. 2.2. 2,  the  initial  a  used  for  all  trajectories  was  the  set  of  values 
found  after  the  algorithm  reached  steady  state  error  on  Trajectory  2.  One  heuristic 
way  to  arrive  at  an  initial  set  of  a  values  was  to  switch  the  magnitudes  of  parameters 
one  and  two.  This  method  usually  allowed  the  manipulator  to  track  the  trajectory 
without  becoming  unstable,  but  not  always.  This  particular  issue  will  be  addressed 
further  in  chapter  5. 

4.3.3  Robustness  to  Payload  Variation  The  AMBC/PBPA  algorithm  provides 
essentially  the  same  robustness  to  payload  variation  as  does  the  AMBC/H  algorithm 
(Figure  4.7  and  4.8).  These  figures  show  the  performance  of  both  the  AMBC/H  and 
the  AMBC/PBPA  algorithms  over  Trajectories  1  and  3,  carrying  a  2  Kg  payload. 
The  performance  of  both  is  degraded,  as  compared  to  their  no  load  counterparts; 
however,  both  the  AMBC/H  algorithm  and  the  AMBC/PBPA  algorithm  provide 
essentially  the  same  accuracy  after  five  passes. 

4.3.4  Decreasing  Number  of  Estimated  Parameters 

Since  a  byproduct  of  the  Principal  Base  Parameter  Analysis  is  an  ordering  of  the 
parameters  by  strength,  there  is  now  a  mathematical  basis  for  decreasing  the  number 
of  estimated  parameters.  Leahy  and  Whalen  used  their  extensive  knowledge  of  the 
PUMA  dynamics  as  a  basis  for  parameter  reduction.  Unfortunately,  most  industrial 
applications  will  not  have  the  luxury  of  that  expertise.  Since  the  elements  of  p*  are 
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Figure  4.1.  AMBC/H  vs.  AMBC/PBPA  -  Trajectory  1 
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Figure  4.2.  AMBC/H  vs.  AMBC/PBPA  -  Trajectory  2 
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Figure  4,3.  AMBC/H  vs.  AMBC/PBPA  -  Trajectory  3 
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Figure  4.4.  AMBC/H  vs.  AMBC/PBPA  -  Trajectory  5 
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Figure  4.5.  AMBC/H  vs.  AMBC/i’BPA  -  Trajectory  6 
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Figure  4.6.  Illustration  that  AMBC/H  and  AMBC/PBPA  do  not  converge  -  Tra¬ 
jectory  3 
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Figure  4.7.  AMBC/H  vs.  AMBC/PBPA  -  Trajectory  1  with  2KG  Payload 
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Figure  4.8.  AMBC/H  vs.  AMBC/PBPA  -  Trajectory  3  with  2KG  Payload 
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Table  4.3.  Comparison  of  a  Values;  16  Estimated  Parameters 


Parameter 

Number 

After  Traj  1, 
Run  5 

After  Traj  2, 
Run  5 

After  Traj  3 
Run  5 

1 

28.477 

3.5538 

3.641 

1.9504 

2 

-9.66729 

-51.5196 

-50.0590 

-49.4823 

3 

7.52559 

-6.7353 

-6.2001 

-6.8044 

4 

6.820 

-0.1414 

0.4095 

5 

5.950 

2.1692 

4.3580 

6 

4.5 

-6.4271 

-5.8339 

-5.7234 

7 

3.91 

6.9872 

6.3920 

8 

3.5 

-0.4327 

-0.2136 

9 

3.5 

1.6702 

-0.5122 

-0.6259 

10 

1.49726 

-0.4741 

0.4858 

0.5110 

11 

1.32209 

6.8264 

7.1849 

7.0275 

12 

-1.29028 

4.4262 

4.4432 

4.3942 

13 

-1.09687 

5.1568 

5.6519 

5.0783 

14 

0.680048 

5.4671 

5.5478 

15 

-0.618251 

5.5158 

5.4455 

5.4122 

16 

-0.460108 

-4.6204 

-4.5763 

-4.5672 

ordered  by  sensitivity,  if  it  is  desired  to  reduce  the  number  of  estimated  parameters, 
one  can  simply  remove  the  appropriate  number  of  parameters  from  the  end  of  p*. 
When  the  number  of  estimated  parameters  decrease,  the  number  of  non-estimated 
parameters  increase  correspondingly  (refer  to  section  4.2.2).  Figures  4.9-4.11  illus¬ 
trate  the  effect  of  reducing  the  number  of  estimated  parameters.  It  can  be  seen 
that  minimal  degradation  in  tracking  accuracy  occurs  until  only  seven  parameters 
are  estimated.  Table  4.4  sets  out  the  final  a  values  for  the  same  trajectories  as  were 
used  in  Table  4.3. 
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Figure  4.10.  Effect  of  Reducing  Number  of  Estimated  PBPA  Parameters:  Fifth 
Run,  Trajectory  2 
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Figure  4.11.  Effect  of  Reducing  Number  of  Estimated  PBPA  Parameters:  Fifth 
Run,  Trajectory  3 
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Table  4.4.  Comparison  of  a  Values;  7  Estimated  Parameters 


Parameter 

Number 

After  Traj  1, 
Run  5 

After  Traj  2, 
Run  5 

After  Traj  3 
Run  5 

1 

28.477 

0.2242 

3.641 

-1.3817 

2 

-9.66729 

-55.5330 

-50.0590 

-52.4891 

3 

7.52559 

-5.4105 

-6.3326 

4 

6.820 

-0.8487 

0.0082 

1.0310 

5 

5.950 

2.0968 

4.3580 

4.6289 

6 

4.5 

-5.0666 

-5.8339 

-3.3298 

7 

3.91 

8.2137 

6.1118 

5.6362 

This  simple  method  of  parameter  reduction  is  another  advantage  of  AMBC/PBPA 
over  AMBC/H.  As  previously  stated,  if  it  were  desired  to  reduce  the  number  of  pa¬ 
rameters  estimated  on  line,  one  could  simply  use  nomimal  physical  values  for  the  non- 
estimated  elements  of  the  AMBC/PBPA  parameter  vector.  This  simple  reduction 
technique  is  impossible  with  AMBC/H  -  one  cannot  (without  extensive  knowledge 
of  the  manipulator  dynamics)  judge  the  relative  importance  of  the  parameters. 

One  surprising  result  came  out  of  this  parameter  reduction  exercise.  In  all  cases, 
as  expected,  performance  decreased  as  less  parameters  were  estimated  (adapted). 
However,  in  some  cases,  when  the  number  of  estimated  parameters  is  decreased  from 
seven  to  four,  tracking  accuracy  actually  increases  (Figures  4.12  and  4.13).  This 
result  is  incongruent  with  the  expected  results  and  bears  further  investigation. 

4-8.5  Importance  of  Accurate  Knowledge  of  Physical  Values 

Adaptive  algorithms,  as  a  whole,  may  enable  a  controller  to  overcome  lack  of 
a  priori  knowledge  of  the  dynamics  of  a  manipulator.  This  section  is  to  address  the 
importance  of  accurate  knowledge  of  the  physical  values  of  the  manipulator  under 
study  (e.g.  masses,  link  lengths,  inertias).  For  this  test,  the  physical  values,  as  given 
by  Tarn  and  Bejczy  are  varied  by  -}-/-  20%  [27].  P*  was  then  re-normalized  and  used 
in  place  of  the  original  P"^  (refer  to  sections  3.2.2and  4.2.3).  Figures  4.14  and  4.15 
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Figure  4.13.  Effect  of  Reducing  Number  of  Estimated  PBPA  Parameters:  Fifth 
Run,  Trajectory  3 
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show  that  the  AMBC/  PBPA  controller  is  somewhat  sensitive  to  accurate  knowledge 
of  physical  system  values;  however,  this  a  priori  knowledge  is  not  absolutely  essential 
to  operation.  Figure  4.14  demonstrates  an  oscillation  on  the  -20%  error  plot.  This 
oscillation  can  be  squashed  by  lowering  the  scale  factor  slightly,  with  a  corresponding 
increase  in  time  to  steady  state  error. 

4.3.6  Adaptation  versus  Pattern  Leaiming 

The  previous  sections  have  demonstrated  that  the  AMBC/PBPA  algorithm  can 
adapt  sucessfully  to  new  trajectoies.  Another  questions  to  be  asked  is  whether  the 
algorithm  is  adapting  during  the  run,  even  after  steady  state  error  is  reached.  Figures 
4.16  addresses  this  issue.  For  this  test,  the  indicated  trajectory  was  run  until  steady 
state  error  was  reached.  After  steady  state  error  occurred,  the  adaption  was  turned 
off  (P"^  =  0)  causing  the  trajectory  to  be  run  with  a  constant  feedforward  torque 
applied.  Figure  4.16  shows  that  adaptation  is  occurring  during  the  trajectory,  even 
after  steady  state  error  is  reached.  This  is  an  indication  that  the  algorithm  has  not 
simply  ’learned’  a  pattern. 

4.8.7  Soft  PD  Gains 

All  of  the  testing  up  to  this  point  has  used  stiff  PD  feedback  gains  (ref  4.1) 
in  conjunction  with  the  AMBC  algorithm.  This  portion  of  the  test  plan  adjusted 
the  PD  gains  to  the  ’soft’  values  shown  in  Table  4.5.  The  use  of  high  feedback  gain 
initially  improves  PUMA  tracking  performance  (e.g.  before  adaptation)  [18,  15]. 
Figure  4.17  shows  how  this  change  affects  performance.  Initially,  tracking  error  is 
higher,  but  steady  state  error  is  essentially  the  same  (as  compared  to  the  high  PD 
gain  plots). 

If  these  results  are  compared  to  those  shown  is  Figure  2.1  (Trajectory  1,  stiff 
PD  gains),  two  items  should  be  noted.  First,  the  relative  tracking  performance  of 
the  two  algorithms  remains  the  same  -  AMBC/II  is  better  by  an  appro.ximate  factor 
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Figure  4.14.  Effect  of  Varying  Physical  Parameter  Values:  Trajectory  1,  Run  5 
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Figure  4.15.  Effect  of  Varying  Physical  Parameter  Values:  Trajectory  3,  Run  5 
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Figure  4.16.  Effect  of  Discontinuing  Adaptation  -  Trajectory  1 
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Table  4.5.  Soft  PD  Feedback  Gains 


Joint  1 

Joint  3 

m 

250.0 
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of  two.  Secondly,  while  the  initial  error  is  much  higher  for  the  soft  PD  gain  scenario, 
steady  state  error  for  both  Ccises  (soft  and  stiff  PD  gains)  is  close  to  the  same  profile. 

4.3.8  Two  Way  Tracking  Evaluation 

The  testing  described  in  the  previous  sections  moved  the  manipulator  through 
unidirectional  trajectories.  Figure  4.18  shows  the  effect  of  a  bidirectional  trajectory. 
This  particular  test  moved  the  arm  through  Trajectory  1,  then  back  to  the  initial  po¬ 
sition  after  a  midpoint  pause  of  500  msec.  This  figure  shows  that  the  AMBC/PBPA 
algorithm  still  provides  excellent  tracking  accuracy.  The  spike  just  past  midpoint  is 
due  to  drive  train  stiction,  as  the  manipulator  changed  direction. 

4.3.9  Very  Slow  Tracking 

This  scenario  (Figure  4.19)  is  included  to  provide  a  link  to  previous  AFIT  re¬ 
search  [15].  As  with  previous  scenarios,  AMBC/PBPA  provides  essentially  the  same 
tracking  accuracy  as  does  the  AMBC/H  algorithm.  This  particular  scenario  is  valu¬ 
able  in  showing  that  even  with  the  stiff  PD  gains,  the  manipulator  can  successfully 
track  without  significant  vibration. 

4.3.10  Effect  of  Varying  the  P"^  Scaling  Factor 

At  several  points  during  this  report,  the  scaling  factor  for  the  AMBC/PBPA 
algorithm  has  been  discussed.  Figures  4.20  and  4.21  illustrate  the  importance  of  this 
scaling  factor.  As  stated  in  section  4.2.3,  the  scaling  factor  used  for  the  previous  plots 
was  0.02.  Again,  this  was  the  largest  value  that  could  be  used  while  allowing  tracking 
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Figure  4.18.  Two  Way  Trajectory  Tracking  Evaluation,  No  Payload,  Trajectory  1 
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AMBC/PBPA,  Run  1 

- 

AMBC/PBPA,  Run  3 
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Figure  4.19.  Very  Slow  Tracking  Evaluation,  No  Payload,  Trajectory  3 


AMBC/H,  Run  1 

- - 

AMBC/H,  Run  5 

AMBC/PBPA,  Run  1 

AMBC/PBPA,  Run  5 
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over  the  entire  trajectory  suite.  This  value  was  determined  experimentally;  however, 
this  tuning  process  took  minutes  as  opposed  to  the  months  required  to  tune  the 
AMBC/H  If  the  scaling  factor  is  set  too  high,  instability  occurs.  If  the  scaling 
factor  is  too  low,  time  to  steady  state  error  increases.  The  scaling  factor  chosen 
for  some  arbitrary  task  is  trajectory  dependant.  That  is,  for  a  repetative,  single 
motion,  the  scaling  factor  can  be  set  somewhat  higher,  causing  quick  convergence  to 
steady  state  error.  An  application  that  has  many  associated  motions  would  require 
a  smaller  scaling  factor  -  this  trades  off  time  to  steady  state  error  against  flexability. 
Regardless,  changing  the  scale  factor  is  only  the  matter  of  a  few  keystrokes. 

4.3.11  Numerical  Comparison 

In  a  recent  paper  by  Whitcomb,  Rizzi  and  Koditschek  [19],  they  state  that  a 
visual  comparison  of  graphs,  such  as  those  used  in  this  study,  often  become  an  act  of 
aesthetic  judgement  rather  that  empirical  analysis.  They  propose  that  using  a  scalar 
norm  (i/^)  would  be  a  preferable  alternative  since  it  would  provide  a  single,  numerical 
measure  of  tracking  performance  for  the  entire  error  plot  [19].  Their  equation  is 

(4.1) 

I  Jto 

where  e(t)  is  a  selected  scalar  (or  vector)  valued  tracking  error.  The  norm  measures 
the  root-mean-square  ’average’  of  the  tracking  error,  thus  a  smaller  represents  a 
smaller  tracking  error  [19].  This  equation  was  applied  against  all  of  the  trajectories 
and  selected  runs  and  the  results  are  compiled  in  Table  4.6.  For  each  of  the  cases 
shown,  the  equation  was  applied  to  the  error  profile  for  the  equivalent  AMBC/H 
and  AMBC/PBPA  run.  The  resultant  number  for  AMBC/H  was  then  divided  by 
the  resultant  number  for  AMBC/PBPA.  The  final,  single  scalar  value  is  the  ratio 
of  the  AMBC/H  error  to  the  AMBC/PBPA  error.  Therefore,  if  =  1  it  indicates 
that  both  algorithms  delivered  the  same  error  performance,  <  1  indicates  that 
AMBC/H  performed  better  and  if  >  1,  AMBC/PBPA  performed  better.  One 
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Error  (radians)  Error  (radians) 


piece  of  abberant  behavior  should  be  noted  -  AMBC/H  was  unable  to  track  Trajec¬ 
tory  4  after  3  runs;  therefore,  the  values  shown  for  that  particular-case  are  unusually 
large. 


Table  4.6.  Comparison  of  Tracking  Errors  using  Equation  4.5 


Trajectory 

Joint  1 

Run  #  1 
Joint  2 

Joint  3 

Joint  1 

Run  #  5 
Joint  2 

Joint  3 

1 

0.3248 

0.9370 

1.1189 

0.6535 

0.5302 

0.5984 

2 

0.2528 

0.1650 

0.2883 

0.6198 

0.7052 

0.7735 

3 

0.9434 

1.3639 

1.2248 

0.7177 

1.3013 

0.6257 

4 

0.8876 

0.7236 

0.5491 

26.2056 

25.2412 

19.0522 

5 

0.8655 

0.3345 

1.6882 

1.5449 

0.6516 

1.2481 

6 

0.6510 

0.6110 

0.4085 

0.9505 

0.4219 

0.6420 

1  (2Kg) 

0.7072 

1.7161 

1.1891 

0.6232 

0.6516 

0.4915 

3  (2Kg) 

0.4087 

1.1055 

1.3721 

0.6630 

0.7152 

0.4699 

Table  4.6  reinforces  what  can  be  seen  in  all  of  the  figures  that  compare 
AMBC/H  to  AMBC/PBPA  -  that  is,  while  AMBC/H  usually  provides  somewhat 
better  error  tracking,  both  algorithms  perform  to  the  same  order  of  magnitude.  Ex¬ 
cept  for  the  abberant  case  of  Trajectory  four,  at  no  time  does  either  algorithm  out¬ 
perform  the  other  by  more  than  a  factor  of  four  -  typically,  AMBC/H  outperforms 
AMBC/PBPA  by  a  factor  of  two.  This  difference  in  performance  is  a  significant 
amount  (e.g.  two  times  as  good);  however,  it  must  be  remembered  that  these  errors 
are  in  thousandths  of  radians.  At  such  a  level  of  accuracy,  a  difference  of  two  to 
one  would  be  insignificant  for  most  industrial  applications.  Additionally,  it  must  be 
remembered  that  the  AMBC/PBPA  algorithm  was  tuned  in  minutes  versus  months 
for  the  AMBC/H  algorithm.  In  many  applications,  this  time  savings  may  be  an 
acceptable  trade-off  for  the  decrease  in  performance. 
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4-4  The  Utah/MIT  Dexterous  Hand 


As  stated  earlier,  the  intention  was  to  cross  check  this  procedure  on  a  second 
manipulator  -  specifically,  the  UTAH/MIT  Dexterous  Hand  (UMDH).  Since  the  time 
of  the  study  performed  by  Rainey,  [22]  the  computer  interface  to  the  UMDH  (along 
with  the  associated  operating  system)  has  changed.  This  hardware  change  neces- 
satated  software  changes.  Unfortunately,  due  to  delays  in  the  hardware  becoming 
operational,  the  tie  does  not  remain  to  complete  this  part  of  the  study.  To  date, 
PBPA  has  been  completed  on  the  UMDH,  using  the  same  2  DOF  configuration  as 
Rainey  [22].  In  addition,  the  results  of  the  PBPA  have  been  used  to  create  an  AMBC 
algorithm  for  the  hand.  Only  the  test  and  evaluation  of  this  algorithm  remains  to  be 
done.  Completion  of  this  project  should  be  considered  as  an  area  for  future  study. 

4-5  Summary 

A  exhaustive  comparison  of  the  two  algorithm  versions  has  been  performed. 
These  results  indicate  that  actually  able  to  provide  the  minimal  set  of  parameters 
needed  by  and  Adaptive  Model-Base  Control  algorithm.  Furthermore,  this  method 
of  determining  the  minimal  parameters  also  allows  for  a  quick  and  simple  method  of 
tuning  the  AMBC  controller  for  optimal  performance. 
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V.  Conclusions  and  Recommendations 

5.1  Conclusions 

Principal  Base  Parameter  Analysis  provides  a  straightforward,  mathernatical 
method  for  determining  the  base  parameter  set  of  a  vertically  articulated  manipu¬ 
lator.  More  importantly,  this  analysis  allows  the  user  to  easily  fine  tune  the  feed¬ 
forward  gain  for  optimal  performance  in  a  logical,  methodical  manner.  This  Tun¬ 
ing/Parameter  Reduction  technique  has  two  advantages.  First,  the  straightforward 
procedure  frees  the  AMBC  designer  from  needing  extensive  knowledge  of  the  manip¬ 
ulator  dynamics.  The  second  advantage  is  the  great  time  savings  during  the  tuning 
process.  Starting  with  just  the  torque  equations,  a  designer  with  knowledge  of  the 
PBPA  process  and  a  symbolic  mathematics  software  package  can  design  and  imple¬ 
ment  an  AMBC  algorithm  in  just  a  few  short  hours.  This  quick  design  may  not 
meet  or  exceed  the  performance  of  an  AMBC  algorithm  tuned  over  the  course  of 
months,  but  for  many  industrial  applications,  this  performance  degradation  would 
be  acceptable  in  light  of  the  time  savings. 

The  AMBC/PBPA  closely  paralleled  the  performance  of  the  AMBC/H  algo¬ 
rithm  in  every  test  scenario  presented.  In  the  areas  of  simple  trajectory  tracking, 
robustness  to  payload  variation,  very  slow  tracking  et.  al.,  the  AMBC/PBPA  algo¬ 
rithm  performed  adequately.  Furthermore,  the  AMBC/PBPA  converged  to  steady 
state  error  in  three  to  five  runs,  as  did  the  AMBC/H  algorithm.  These  results  lead 
to  the  conclusion  that  PBPA  is  a  viable  option  to  be  used  in  the  design  and  tuning 
of  an  Adaptive  Model-Based  Controller  -  with  the  caveat  that  the  simplicity  will  be 
at  the  cost  of  some  performance  degradation. 

5.2  Recommendations  for  Future  Study 

Often,  advanced  study  efforts  raise  more  questions  than  they  answer.  This 
study  was  no  different.  While  PBPA  may  provide  the  push  needed  to  move  .AMBC 
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out  of  the  lab  and  onto  the  factory  floor,  not  every  question  has  beeitanswered.  This 
section  will  identify  several  areas  which  could  be  explored  in  more  depth. 

5.3  Disparity  Between  AMBC/H  and  AMBC/PBPA 

As  wcis  discussed  in  Chapter  4,  AMBC/H  typically  outperforms  AMBC/PBPA 
by  a  ratio  of  2  to  1.  Theoretically,  since  they  are  both  derived  from  the  same  torque 
equations,  they  should  both  provide  the  same  approximate  performance.  Since  this 
is  obviously  not  the  case,  where  is  the  discrepancy?  Two  possible  causes  of  this 
discrepancy  are  the  physical  values  used  and  the  neglected  dynamics.  First,  no 
special  effort  Wcis  made  to  measure  the  physical  parameters  of  the  manipulator.  This 
approach  was  deemed  acceptable  since  an  AMBC  algorithm  is  to  overcome  this  lack 
of  accurate  knowledge.  Secondly,  the  only  drive  system  information  used  was  viscous 
and  coulombic  friction.  Consequently,  any  neglected  drive  system  information  Wcis 
accounted  for  in  some  other  unrelated  parameter. 

5..^  AMBC/PBPA  Fine  Tuning 

The  attempt  of  the  test  and  evaluation  of  the  PBPA  design  process  was  kept 
strictly  in  the  realm  of  using  one  simple  scale  factor.  If  it  were  desired  to  improve 
the  performance  of  the  AMBC/PBPA  algorithm,  it  would  be  a  simple  matter  to 
heuristically  fine  tune  the  AMBC/PBPA  algorithm  further.  While  this  type  of  fine 
tuning  certainly  does  not  fit  in  with  the  non-heuristic  procedure  developed  in  this 
study,  it  may  be  acceptable  to  expend  some  effort  on  fine  tuning  to  improve  perfor¬ 
mance.  The  suggested  area  for  future  study  is  to  quantify  the  performance  gain  if 
a  manual  fine  tune  of  the  AMBC/PBPA  algorithm  is  performed.  A  second,  related 
area  is  to  duplicate  the  test  suite  used  in  the  study,  using  the  maximum  possible  scale 
factor  in  each  individual  case.  Many  robots  Uocd  in  standard  industrial  application 
have  a  limited  repetoire  of  motions.  In  such  a  case  it  would  be  acceptable  to  have  a 
separate,  optimal  scale  factor  for  each  movement. 
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5.5  Cross  Check  of  Procedure  on  a  Second  Platform 

As  discussed  <>arlier,  the  intent  was  to  cross  check  the  results  of  this  study  on 
a  second  robotic  platform.  Due  to  delays  in  hardware  development,  this  sideline 
was  not  feasible.  This  particular  area  of  study  is  of  pri.i  s  importance  to  prove 
that  the  PBPA  design  technique  is  not  platform  specific.  The  second  robot  that 
was  designated  to  be  the  cross  check  platform  was  the  Utah/MIT  Dexterous  Hand 
(UMDH).  This  robot  would  be  an  excellent  choice  for  this  type  of  study  since  it’s 
internal  dynamics  are  not  well  known  (as  are  the  PUMA’s).  Consequently,  any 
heuristic  tuning  done  on  the  UMDH  would  be  simple  trial  and  error  and  not  assisted 
by  any  intuitive  jumps  of  logic.  If  the  PBPA  developed  AMBC  algorithm  could 
out-perform  a  heuristically  tuned  AMBC  algorithm,  it  would  be  substantial  proof 
that  PBPA  is  not  just  a  quixotic  idea. 

The  pursuit  of  these  recommendations  could  advance  PBPA  as  a  possible  AMBC 
design  approach  into  an  integral  part  of  every  robotic  design  toolbox. 

5.6  Summary 

The  PUMA  560  has  been  the  platform  used  for  extensive  study  of  Adaptive 
Model-Based  Control  algorithms  at  the  Air  Force  Institute  of  Technology  [16].  Dur¬ 
ing  the  course  of  these  studies,  researchers  have  been  able  to  heuristically  tune  the 
adaptation  gains  for  optimal  performance.  Furthermore,  they  have  been  able  to  re¬ 
duce  the  parameter  set  used  with  no  negative  effect  on  the  tracking  accuracy.  The 
purpose  of  this  study  was  to  apply  the  Principal  Base  Parameter  Analysis  technique 
to  the  PUMA  560,  incorporate  the  reduced  parameter  set  into  the  existing  AMBC 
algorithm,  then  contrast  the  tracking  accuracy  achieved  with  the  PBPA  reduced 
parameter  set  against  previous  results.  The  final  result  is  that  there  is  a  method, 
essentially  free  of  heuristics,  for  developing  and  tuning  an  Adaptive  Model-Based 
Controller.  The  simple,  straightforward  procedure  detailed  in  this  report  may  be 
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the  key  that  allows  AMBC  to  move  out  of  the  laboratory  and  into  operational  ap¬ 
plications. 
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Appendix  A.  Comprehensive  Set  of  Figures 
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Figure  A. 7. 
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Figure  A. 9.  Demonstration  of  Whether  or  Not 
AMBC/PI  and  AMBC/PBPA  Ever 
Become  Equal:  Run  1,  Traj  3 
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Figure  A.  10.  Demonstration  of  Whether  or  Not 
AMBC/H  and  AMBC/PBPA  Ever 
Become  Equal:  Run  5,  Traj  3 
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Figure  A.ll.  Demonstration  of  Whether  or  Not 
AMBC/H  and  AMBC/PBPA  Ever 
Become  Equal,  Traj  3 
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Figure  A.12.  AMBC/H  vs.  AMBC/PBPA  -  Tra 
jectory  1  with  2KG  Payload 
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Figure  A.13.  AMBC/H  vs.  AMBC/PBPA  -  Tra*  Figure  A.14. 
jectory  3  with  2KG  Payload 
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Figure  A. 15.  EfFect  of  Reducing  Number  of  Esti¬ 
mated  PBPA  Parameters:  First  Run, 
Trajectory  1 
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Figure  A. 16.  Effect  of  Parameter  Reduction:  Fifth 
Run,  Trajectory  1 
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Figure  A. 17.  Effect  of  Reducing  Number  of  Esti¬ 
mated  PBPA  Parameters:  Fifth  Run. 
Trajectory  1 
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Figure  A. 18.  Effect  of  Reducing  Number  of  Esti 
mated  PBPA  Parameters:  First  Run 
Trajectory  2 
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Figure  A. 19.  Effect  of  Reducing  Number  of  Esti-  Figure  A.20.  Effect  of  Reducing  Number  of  Esti 
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Trajectory  2  Trajectory  2 


10  Parameters 


7  Parameters 


4  Parameters 


2  Parameters 


16  Parameters 


13  Parameters 


10  Parameters 


7  Parameters 


A-11 


Error  (radians)  Error  (radians)  Error  (radians) 


Joint  1 


Joint  1 


Time  (seconds)  Time  (seconds) 


Joint  2 


Time  (seconds) 


Joint  2 


Time  (seconds) 


Time  (seconds) 


Time  (seconds) 


Figure  A. 21.  Effect  of  Reducing  Number  of  Esti¬ 
mated  PBPA  Parameters:  Fifth  Run, 
Trajectory  2 
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Figure  A. 23.  Effect  of  Reducing  Number  of  Esti¬ 
mated  PBPA  Parameters:  First  Run, 
Trajectory  3 
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Figure  A.24.  Effect  of  Reducing  Number  of  Esti¬ 
mated  PBPA  Parameters;  Fifth  Run, 
Trajectory  3 
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Figure  A. 25.  Effect  of  Reducing  Number  of  Esti¬ 
mated  PBPA  Parameters:  Fifth  Run, 
Trajectory  3 
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Figure  A. 26.  Effect  of  Varying  Physical  Parameter 
Values:  Trajectory  1,  Run  1 
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Figure  A. 31.  Effect  of  Varying  Physical  Parameter 
Values:  Trajec  ory  3,  Run  5 
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Figure  A.35.  Effect  of  Soft  PD  Gains,  Trajectory  Figure  A.36.  Effect  of  Soft  PD  Gains,  Trajectory 
1,  2KG  Payload  3,  No  Payload 
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Figure  A.37.  Effect  of  Soft  PD  Gains,  Trajectory 
3,  2KG  Payload 
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Figure  A.39.  Effect  of  Soft  vs.  Stiff  PD  Gains  on  Figure  A.40.  Effect  of  Soft  vs.  Stiff  PD  Gains  on 
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Figure  A.41.  Effect  of  Soft  vs.  Stiff  PD  Gains  on 

the  PBPA  Algorithm,  Trajectory  3,  Figure  A.'ia.  Two  Way  Trajectory  Tracking  Eval 
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Figure  A. 43. 


Very  Slow  Tracking  Evaluation,  No  Figure  A.44.  Very  Slow  Tracking  Evaluation,  No 
Payload,  Trajectory  1  Payload,  Trajectory  2 


AMBC/H,  Run  1 

AMBC/H,  Run  5 

AMBC/PBPA,  Run  1 

AMBC/PBPA,  Run  5 

AMBC/H,  Run  1 

AMBC/H,  Run  5 

AMBC/PBPA,  Run  1 

AMBC/PBPA,  Run  5 

A-23 


Error  (radians)  Error  (radians)  Error  (radians) 


Joint  1 


Joint  1 


Error  (radians}  Error  (radians)  Error  (radians) 


Joint  1 


Joint  1 


Time  (seconds) 
Joint  2 


Joint  3 


Time  (seconds) 

Figure  A.47.  Effect  of  Varying  Scale  Factor 
for  AMBC/PBPA  Algorithm,  Trajec¬ 
tory  1,  Run  5 
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Figure  A.48.  Effect  of  Varying  F"^  Scale  Factor 
for  AMBC/PBPA  Algorithm,  Trajec¬ 
tory  3,  Run  1 
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Appendix  B.  PUMA-560,  Three  Degree  of  Freedom  Values 

As  discussed  in  section  3.2.2,  the  following  are  the  actual  values  used  for  the 
regressor  matrix,  p*  and  the  ki  matricies  in  the  AMBC/PBPA  algorithm. 

B.l  The  Non-linear  Function  Vector,  nO 


nO(l)  =  QDDl 

n0(2)  =  QDDl*sin2 

n0(3)  =  qDDl*cos2**2 

n0(4)  ==  QDDi*cos2*cos23 

n0(5)  =  QDDl*cos2*sin23 

n0(6)  =  QDDl*cos23 

n0(7)  =  QDDl*sin23 

n0(8)  =  QDDl+cos23*sin23 

n0(9)  =  QDDl*sin23**2 

nO(lO)  =  QDD2 

nO(ll)  =  QDD2*sin2 

n0(12)  =  QDD2*cos3 

n0(13)  =  QDD2*sin3 

n0(14)  =  QDD2*cos23 

n0(15)  =  QDD2*sin23 

n0(16)  =  QDD3 

n0(17)  =  QDD3*cos3 

n0(18)  =  QDD3*sin3 

n0(19)  =  qDD3*cos23 

n0(20)  =  QDD3*sin23 

n0(21)  =  qOl 

n0(22)  =  qDl**2 

n0(23)  =  QDl**2*cos2 

n0(24)  =  qDl**2*cos2*sin2 

n0(25)  =  qDl**2*cos2*cos23 

n0(26)  =  qDl**2*cos2*sin23 

n0(27)  =  qDl**2*sin2*sih23 

n0(28)  =  qDl*=i=2*sin2*sin3*sin23 

n0(29)  =  qDl**2*cos23**2 

n0(30)  =  qDl**2*sin3 

n0(31)  =  QDl**2*cos3*sin3 


B-1 


n0(32)  =  QDl*qD2 

nO(33)  =  QDl*QD2*cos2 

hO(34)  =  QDl*QD2*cos2*sin2 

n0(35)  =  qDl*qD2*cos2*cos23 

n0(36)  =  QDl*QD2*cos2*sin23 

n0(37)  =  QDl*QD2*sin2*sin23 

n0(38=)  =  QDl*QD2*sin2*sin3*sin23 

n0(39)  =  QDl*QD2*cos23**2 

n0(40)  =  QDl*QD2*sin3 

nO(41)  =  qDl*QD2*cos3*sin3 

n0(42)  =  QD1+QD3 

n0(43)  =  qDl*qD3*cos2*sin2 

nO(44)  =  qDl*qD3*cos2*cos23 

n0(45)  =  qDl*qD3*cos2*sin23 

n0(46)  =  qDl*qD3*sin2*sin3*sin23 

nO(47)  =  qDl*qD3*cos23**2 

n0(48)  =  qDl*qD3*cos3*sin3 

n0(49)  =  qD2 

n0(50)  =  qD2**2*cos3 

n0(51)  =  qD2*qD3*cos3 

n0(52)  =  qD2*qD3*sin3 

n0(53)  =  qD2*qD3*cos23 

n0(54)  =  qD2*qD3*sin23 

n0(55)  =  qD2**2*cos2 

n0(56)  =  qD2**2*cos23 

n0(57)  =  qD2**2*sin23 

n0(58)  =  qD3 

nO(59)  =  qD3**2*cos3 

n0(60)  =  qD3**2*sin3 

n0(6l)  =  qD3**2*cos23 

n0(62)  =  qD3**2*sin23 

nO(63)  =  cos2 

nO(64)  =  sin2 

n0(65)  =  cos23 

n0(66)  =  sin23 

n0(67)  =  1 

n0(68)  =  qD2**2*sin3 


B.2  Constant  Matricies  of  Kinematic  Parameters,  k. 
In  the  interest  of  space,  zero  values  are  not  shown. 
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kit [[1,44]]  =  .7766 
kit [[21, 38]]  =  1 
klt[[l,l]]  =  1 
klt[[l,6]]  =  1 
klt[[i,23]]  =  1 
kit [[1,24]]  =  1 
klt[[l,30]]  =  1 
lt[[67,41]]  =  1 
klt[[l,18]]  =  2 
klt[[l,26]]  =  2 
kit [[32, 20]]  =  -2 
kit [[42, 20]]  =  -2 
kit [[33,3]]  =  -4 
kit [[55, 4]]  =  1 
klt[[3,5]]  =  1 
klt[[3,6]]  =  -1 
klt[[3,7]]  =  1 
klt[[3,16]]  =  1 
klt[[3,2]]  =  2 
klt[[56,22]]  =  1 
klt[[53,22]]  =  2 
klt[[61,22]]  =  1 
klt[[56,25]]  =  1 
klt[[53,25]]  =  2 
klt[[61,25]]  =  1 
kit [[56, 19]]  =  1 
klt[[53,19]]  =  2 
klt[[61,19]]  =  1 
kit [[14, 27]]  =  -1 
kit [[19, 27]]  =  -1 
kit [[4, 17]]  =  2 
kit [[4, 13]]  =  2 
klt[[35,15]]  =  2 
kit [[44, 15]]  =  2 
kit [[39,20]]  =  4 
kit [[47,20]]  =  4 
kit [[11,12]]  =  1 
klt[[ll,14j]  =  1 
kit [[11,4]]  =  1 
klt[[34,5]]  =  -2 
klt[[34,6]]  =  2 


t 


kit [[46, 18]]  8 

kit [[9, 23]]:  =  -1 
kit [[9,28]]  =  1 
kit [ [9,30]]  =  -1 
kit [[9, 18]]  =  -2 


k2t[[10,44]]  =  2.3616 
k2t[[^  ,39]]  =  1 
k2t[[l),5]]  =  1 
k2t[[10,8]]  =  1 
k2t[[10,29]]  =  1 
k2t[[16,29]]  =  1 
k2t[[10,16]]  =  1 
k2t[[10,23]]  =  1 
k2t[[16,23j]  =  1 
k2t[  [67,42]]  =  1. 
k2t[[10,2]]  =  2 
k2t[[l0,18]]  =  2 
k2t[[16,18]]  =  2 
k2t[[22,20]]  =  1 
k2t[E63,31]]  =  -1 
k2t [[63,34]]  =  -1 
k2t [[63,32]]  =  -1 
'k2t[[23,3]]  =  2 
k2t[[12,17]]  =  2 
k2t[[17,l7]]  =  1 
k2trri2,13]]  =  2 
k2t[i:i7,13]]  =  1 
k2tD[  *51,15]]  =  2 
k2t[Di9.15]]  =  1 
k2t [[65,35]]  =  -1 
k2t[[65,36]]  =  "1 
k2t[[6,27]]  -  -1 

k2t[[25,15]]  =  *'1 
k2t[[29,20]]  =  -2 
k2t[[2,12]]  =  1 
k2t [[64,33]]  =  1 
k2t[[2,14]]  =  1 
k2t[[24,5]]  =  1 
k2t[[24,6j]  =  -1 
k2t[[24,7]]  =  i 


k2t[[24,16]]  =  1 
k2t[C24,23]]  =  1 
k2t[[24,28]]  =  -1 
k2t [[24,30]]  =  1 
k2t[[24,2]]  =  2 
k2t[[24,18]]  =  2 
k2t[[30,17]]  =  -1 
k2t[[52,17]]  =  -2 
k2t[[S0,17]]  =  -1 
k2t[[30,13]]  ■•=  -1 
k2t[[52,13]]  =  -2 
k2t[[60,13]]  =  -1 
k2t[[l3,15]]  =  2 
k2t[ri8,15]]  =  1 
k2t[[31,23]]  =  1 
kt[[31,18]]  =  2 
k2t[[7,22]]  =  1 
k2t[[7,25]]  =  1 
k2t[[7,19]]  =  1 
k2t [[66,37]]  =  -1 
k2t[[26,17]]  =  2 
k2t[[26,13]]  =  2 
k2t[[27,15]]  =  1 
k2t[[28,23]]  =  -2 
k2t[[28,28]]  =  2 
k2t [[28,30]]  =  -2 
k2t[[28,18]]  =  -4 


k3t[[16,44]]  =  .5827 
k3t [[58,40]]  =  1 
k3t [[10,29]]  =  1 
k3t[[16,29]]  =  1 
k3t[[10,23]]  =  1 
k3t[[10,18]]  =  2 
k31;[[l6,18]]  =  2 
k3tL[22,20]]  =  1 
k3tLri2,17]]  =  : 
k3t[[12,13]]  =  1 
k3t[[50,i.5]]  =  -1 
k3t [[65,35]]  =  -1 
k3t[[65,36]]  =  -1 
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k3tCC6,27]3  =  -1 
k3tCC25,15]]  =  -1 
k3t [[29,20]]  =  -2 
k3t [[24,23]]  =  1 
k3t[[24,28]]  =  -1 
k3t [[24,30]]  =  1 
k3t[[24,18]]  =  2 
k3t[[68,17]]  =  1 
k3t[[68,13]]  =  1 
k3t[[13,15]]  =  1 
k3t [[31,23]]  =  1 
k3t [[31,28]]  =  -1 
k3t [[31,30]]  =  1 
k3t[[31,18]]  =  2 
k3t[[7,22]]  =  1 
k3t[[7,25]]  =  1 
k3t[[7,19]]  =  1 
k3t [[66,37]]  =  -1 
k3t[[26,17]]  =  1 
k3t[[26,13]]  =  1 
k3t [[28,23]]  =  -2 
k3t [[28,28]]  =  2 


B.3  The  N on-reduced  Parameter  Set,  p 
The  physical  values  are  as  found  in  [27]. 


p(l)  =  inl*kyyl 
p(2)  =  m2*aa2*xbax2 

p(3)  =  m2*aa2*ybar2 

p(4)  =  m2*aa2*zbar2 

p(5)  =  m2*aa2**2 

p(6)  =  in2*kxx2 

p(7)  =  ra2*kyy2 

p(8)  =  m2*kzz2 

p(9)  =  m2*kxx2 

p(10)  =  m3*xbar3 
p(ll)  =  m3*ybar3 
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p(12)  =  ra3*aa2*dd3 
p(13)  =  ra3*aa2*xbar3 
p(14)  =  ra3*aa2*ybar3 
p(15)  =  ra3*aa2*zbctr3 
p(16)  =  m3*aa2**2 
p(17)  =  m3*aa2=t=aa3 
p(18)  =  m3*aa3*xbeir3 
p(l9)  =  m3*aa3*ybax3 
p(20)  =  ra3*aa3*zbar3 
p(21)  =  in3*aa3 
p(22)  =  ra3*aa3*dd3 
p(23)  =  m3*aa3**2 
p(24)  =  m3*dd3**2 
p(25)  =  m3*dd3*xbar3 
p(26)  =  m3*dd3*ybar3 
p(27)  =  m3*dd3*zbar3 
p(28)  =  m3*kxx3 
p(29)  =  m3*kyy3 
p(30)  =  m3*kzz3 
p(31)  =  m2*GRAV*aa2 
p(32)  =  m2*GRAV*xbar2 
p(33)  =  m2*GRAV*ybar2 
p(34)  =  ra3*GRAV*aa2 
p(35)  =  m3*GRAV*aa3 
p(36)  =  ra3+GRAV*xbar3 
p(37)  =  m3+GRAV*zbar3 
p(38)  =  bn21 
p(39)  =  bn22 
p(40)  =  bn23 
p(41)  =  sftorl 
p(42)  =  sftor2 
p(43)  =  sftor3 
p(44)  =  1 


B.4  The  AMBC/PBPA  Regressor  Matrix 


Y(l,l)  =  0.  -  1.291916379341979*QDi*qD2*cos2  + 

1 .223543615235044*10**-16*qDD2*sin2  - 
6.95748284379206*10**-17*(-(qD2**2*cos2)  -  qDD2*sin2) 
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Y(l,2)  =  0.  -  3.785624396158174*QDl*QD2*cos2 

Y(l,3)  =  0. 

Y(l,4)  =  0. 

Y(l,5)  =  1.0 

Y(l,6)  =  QDl 

Y(l,7)  =  0. 

Y(l,8)  =  0. 

Y(l,9)  =  0. 

Y(l,10)  =  0.  -  1.434315310235834*10**-16*QDl*QD2*cos2  + 

1. 102070 113928819*QDD2*sin2  - 
0. 6266743428547707* (-(QD2**2*cos2)  -  QDD2*sin2) 

Y(l,ll)  =  0.  -  0. 88625 1354856464*QDD2*sin2  - 

0.7792812509020992*(-(QD2**2*cos2)  -  QDD2*sin2) 

Y(l,12)  =  -0.295459647105532*qDDl  + 

0, 01225149578425218* (-QDD1  +  2*QDDl*cos2**2  - 
4*QDl*QD2*cos2*sin2)  - 
1. 377020985552159* (-QDD1  +  qDDl*cos2**2  - 
2*qDl*qD2*cos2*sin2)  + 

3 . 939813994754334* (-2*qDl*qD2*cos2*sin2  - 
2*qDl*qD3*cos2*sin2  -  2*qDl*qD2*cos3*sin3  - 
2*qDl*qD3*cos3*sin3  +  4*qDl*qD2*sin2*siii3*sin23 
4*qDl*qD3*sin2*sin3*sin23  -  qDDl*5in23**2)  + 

1 .613375882778644* (2*qDl*qD2*cos2*sin2  + 
2*qDl*qD3*cos2*sin2  + 

2*qDl*qD2*cos3*sin3  +  2*qDl*qD3*cos3*sin3  - 
4*qDl*qD2*sin2*sin3*sin23  - 
4*qDl*qD3*sin2*sin3*sin23  +  qDDl*sin23**2)  + 
3.636549415076395*(-qDDl  +  2*qDl*qD2*cos2*sin2  + 
2*qDl*qD3*cos2*sin2  +  2*qDl*qD2*cos3*sin3  + 
2*qDl*qD3*cos3*sin3  -  4*qDl*qD2*sin2*sin3*sin23 
4*qDl*qD3*sin2*sin3*sin23  +  qDDl*sin23**2) 
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Y(l,13)  =  0. 


YCl,14)  =  0.03071435139678527+QDDl  + 

0.0971847547297091*(-QDD1  +  2*QDDl*cbs2**2  - 
4*QDl*QD2*cos2*sin2)  + 

0. 907177973662084* (-QDD1  +  QDDr*cos2**2  - 
2*QDl+QD2*cos2*sin2)  - 
0 .94462043 1342006* (-2*QDl*QD2*cos2*sin2  - 
2*QDl*QD3*cos2*sin2  -  2*QDl*QD2*cos3*sin3= - 
2*QDl*QD3*cos3*siii3  +  4*QDl*QD2*sin2*sin3*sin23  + 
4*QDl*QD3*sin2*sih3*sin23  -  QDDl*sin23**2)  + 

1 . 656684419083955* (2*QDl*QD2*cos2*sin2  + 
2*QDl*QD3*cos2*sin2  + 

2*QDl*QD2*cos3*sin3  +  2*QDl*QD3*cos3*sin3  - 
4*QDl*QD2*sin2*sih3*sin23  - 
4*QDl*QD3*sin2*sin3*sin23  +  QDDl*sin23**2)  - 
1.105 183688973447* (-QDD1  +  2*QDl*QD2*cos2*sin2  + 
2*QDl*QD3*cos2*sin2  +  2*QDl*QD2*cos3*sin3  + 
2*QDl*QD3*cos3*sin3  -  4*QDl*QD2*sin2*siii3*sin23  - 
4*QDl*QD3*sin2*siii3*sin23  +  QDDl*sin23**2) 

Y(l,15)  =  -0.i907450736312253*QDDl  + 

0. 07015604633145501* (-QDD1  +  2*QDDl*cos2**2  - 
4*QDl*qD2*cos2*sin2)  + 

0.585 13755877427* (-QDDl  +  qDDl*cos2**2  - 
2*QDl*qD2*cos2*sin2)  + 

0 . 0950052880231652* (-2*qDl*qD2*cos2*sin2  - 
2*QDl*qD3*cos2*sin2  -  2*qDl*qD2*cos3*sin3  - 
2*qDl*qD3*cos3*sin3  +  4*qDl*qD2*sin2*sin3*sin23  + 
4*QDl*qD3*sin2*sin3*sin23  -  qDDl*sin23**2)  - 
0 .001127205963008193*C2*qDl*qD2*cos2*sin2  + 
2*QDl*qD3*cos2*sin2  +  2*qDl*qD2*cos3*sin3  + 
2*qDl*qD3*cos3*sin3  -  4*qDi*qD2*sin2*sin3*sin23  - 
4*QPl*qD3*sin2*sin3*siii23  +  qDDl*sin23**2)  - 
1.476001365402235*(-qbDl  +  2*qDl*qD2*cos2*sin2  + 
2*qDl*qb3*cos2*sin2  +  2*qDl*qD2*cos3*sin3  + 
2*QDl*qP3*cos3*sin3  -  4*qDl*qD2*sin2*sin3*sin23  - 
4*QPl*qD3*sin2*siii3*sin23  +  qPPl*sin23**2) 

YCl,16)  =  -0.3680403457911835*QDD1  + 

0. 1524306276280933* (-qODl  +  2*qDDl*cps2**2  - 
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4*QDl*QD2*cbs2*sin2)  - 
1.367130671348102*(-QDD1  +  qDDl*cos2**2  - 
2*QDl*QD2*cos2*sin2)  - 
1 . 220605484649777* (-2*QDl*QD2*cos2*sin2  - 
2*QDl*qD3*cos2*sih2  -  2*QDl*QD2*cbs3*sin3  - 
2*QDl*QD3*cos3*sin3  +  4*QDl*QD2*sin2*sin3*sin23  + 
4*QDl*QD3*sin2*sin3*sin23  -  QDDl»:-sin23**2)  - 
0 . 7599456368395224* (2*QDl*QD2*cos2*sin2  + 
2*QDl*QD3*eos2*sin2  +  2*QDl*QD2*cds3*sin3  + 
2*QDl*QD3*cos3*sin3  -  4*QDl*QD2*sin2*sin3*sin23  - 
4*qDl*qD3*sin2*sin3*sin23  +  qDDl*sin23**2)  - 
1. 124898280211656* C-qODl  +  2*qDl*qD2*cos2*sin2  + 
2*qDl*qD3*cos2*sin2  +  2*qDl*qD2*cos3*sin3  + 
2*qpi*qD3*cos3*sin3  -  4*qDl*qD2*sin2*sin3*sin23  - 
4*qDl*qD3*sin2*sin3*sin23  +  qDDl*sin23**2) 

Y(l,17)  =  0.  +  l.*(-2*qDl*qD2*cos2*cos23  - 

2*qDl*qD3*cos2*cos23  -  2*qDDl*cos2*sin23  + 
2*qDl*qD2*sin2*sin23) 

Y(l,18)  =  -0. 421709828097 1802*qDDl  + 

0.4935339141969876*(-qDDl  +  2*qDDl*cos2**2  - 
4*qDl*qD2*cos2*siii2)  + 

0. 820526775345378* (-qODl  +  qDDl*cos2**2  ^ 
2*qDl*qD2*cos2*sin2)  - 
0 . 6732582230870278* (-2*qDl*qD2*cos2*sin2  - 
2*qDl*qD3*cos2*sin2  -  2*qDl*qD2*cos3*sin3  - 
2*qDl*qD3*cos3*sin3  +  4*qDl*qD2*sin2*sin3*sin23  + 
4*qDl*qD3*sin2*sin3*sin23  -  qDDl*sin23**2)  - 
0 . 2580049694968252* (2*qDl*qD2*cos2*sin2  + 
2*qDl*qD3*cos2*sin2  +  2*qpi*qD2*cos3*sin3  + 
2*qDl*qD3*cos3*sin3  -  4*qDl*qD2*sin2*sin3*sin23  - 
4*qDl*qD3*sin2*siii3*sin23  +  qDDl*sin23**2)  - 
0.0893179992172112*(-qDDl  +  2*qDl*qD2*cos2*sin2  + 
2*qpi*qD3*cos2*sin2  +  2*qDl*qD2*cbs3*sin3  + 
2*qDl*qD3*cos3*sin3  -  4*qpi*qD2*sin2*sin3*sin23  - 
4*qDl*qD3*sin2*sin3*sin23  +  qDDl*sin23**2) 

Y(1,19)  =  0. 

Y(l,20)  =  0.  -  l.*(qDD2*cos23  +  qDD3*cos23  -  qD2**2*sin23  - 
2*qD2*qD3*sin23  -  qD3**2*sin23) 
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Y(l,21) 


Y(l,22)  = 

Y(l,23)  = 

Y(l,24)  = 

Y(2,l)  = 

Y(2,2)  = 

YC2,3)  = 
Y(2,4)  = 


-0.4064372364733833*QDD1  - 
0. 6845964743997872* (-QDD1  +  2*QDDl*cos2**2  - 
4*QDl*QD2*c6s2*sin2)  + 

1. 181585758700407* (-QDD1  +  QDDl*cos2**2  - 
2*QDl*QD2*cos2*sin2)  - 
1 . 176170709788934* (-2*QDl*QD2*cos2*sin2  - 
2*QDl=i'QD3*cos2*siii2  -  2*QDl*QD2*cos3*sin3  - 
2*QDl*QD3*cos3*sin3  +  4*QDl*QD2*sin2*sin3*sin23 
4*QDl*QD3*sin2*sin3*sin23  -  QDDl*sin23**2)  - 
0 . 0912676865211562*(2*QDl*QD2*cos2*sin2  + 
2*QDl*QD3*cos2*sin2  +  2*QDl*QD2*cos3*sin3  + 
2*QDl*qD3*cos3*sin3  -  4*QDl*QD2*sin2*sin3*sin23 
4*QDl*QD3*sin2*sin3*sin23  +  QDDl=<'sin23**2)  - 
0. 923105350898833* (-QDD1  +  2*QDl*QD2*cos2*sin2  + 
2*QDl*QD3*c6s2*sin2  +  2*QDl*QD2*cos3*sin3  + 
2*QDl=t‘QD3*cos3*siii3  -  4*QDl*QD2*sin2*siii3*sin23 
4*QDl*qD3*sin2*sin3*sin23  +  QDDl*sin23**2) 

0.  -  l.*(2*qDl*QD2  +  2*qDl*qD3  - 
4*qDl*qD2*cos23**2  - 
4*qDl*qD3*cos23**2  -  2*qDDl*cos23*sin23) 

0.  -  1.414213562373096*(-2*qDDl*cos2*cos23  ^ 
2*qDl*qD2*sin3  +  4*qDl*qD2*cos2*sin23  + 
2*qDl*qD3*cos2*sin23) 

0.  -  1.732050807568877*(-(qD2**2*cos23)  - 
2*qD2*qD3*cos23  -  qD3**2*cos23  -  qDD2*sin23  - 
qDD3*sin23) 


0.  -  1.639223448129551*cos2  + 

0 . 6459581896709893*qDl**2*cos2 

0.  +  0.5594162020376836*cos2  + 

1 .892812198079087*qDl**2*cos2 


0.  -  l,*sin23 


1.0 
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Y(2,5)  =  0. 


Y(2,6)  = 
Y(2,7)  = 
Y(2,8)  = 
Y(2,9)  = 
Y(2,10) 
Y(2,ll) 
Y(2,12) 


Y(2,13) 

Y(2,14) 


Y(2,15) 


0. 


0. 


QD2 


0. 


=  0.  +  1.72874445678359*QDDl*sin2 

=  0.  -  0.1069701039543647*QbDl*sin2 

=  -0.898477340464112*QDD2  + 

3. 48489083 1498359* (-qDD2  -  QDD3)  + 

0. 90984632651194* (-qDD2  -  2*qDl**2*cos2*sin2)  - 
0. 4671746590402205* (qDD2  qDl**2*cos2*sin2)  + 

5 . 053141200540136* (- (qDl**2*cos2*sin2)  - 
qDl**2*cos3*sin3  + 

2*qDl**2*sin2*sin3*sin23)  - 

1. 871514948719715* (-qDD2  -  qDD3  -  2*qDl**2*cos2*sin2 
2*qDl**2*cos3*sin3  +  4*qDl**2*sih2*sin3*sin23) 

=  0.  -  l.*sin2 

=  0.0934007368769639*qDD2  - 
0.6098328552114092*C-qDD2  -  qDD3)  - 
0.6695751522611962*(-qDD2  -  2*qDl**2*cos2*sin2)  + 
0.2376028214008885*(qDD2  -  qDl**2*cos2*sin2)  - 
3 . 036913387138213* (- (qDl**2*cos2*sin2)  ^ 
qDl**2*cos3*sin3  + 

2*qDl**2*sin2*sin3*sin23)  + 

2. 266517274295362* (-qDD2  -  qDD3  -  2*qDl**2*cos2*sin2 
2*qDl**2*cos3*sin3  +  4*qDl**2*sin2*sin3*sin23) 

=  -0.580045796919265*qDD2  + 

0.3134364897250736*(-qDD2  -  qDD3)  - 
0 .4368624034038 167* (-qDD2  ~  2*qDl**2*cds2*si’i2)  + 
d . 148275155370453* (qDD2  -  qDl**2*cos2*sin2)  - 
0 . 943006468012244* (“(qDl**2*cos2*sin2)  r 
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YC2,16) 


Y(2,17) 

Y(2,18) 


Y(2,19) 

Y(2,20) 

Y(2,21) 


qDl**2*cos3*sin3  + 

2*QDl**2*sin2>i'sin3*sin23)  - 

0. 314563695688082* (-QDD2  -  QDD3  -  2*QDl**2*cos2*sin2 
2*QDl**2*cos3*sin3  +  4*QDl**2*sin2*sin3*sin23) 

=  -1.119191450708806*qDD2  - 

1.6255054992231 11* (-QDD2  -  QDD3)  + 

0. 809800029146671* (-QDD2  -  2*QDl**2*cos2*sin2)  - 
0. 5573306422014298* (QDD2  -  QDl**2*cos2*sin2)  - 
2 . 395358157168579* (-(QDl**2*cbs2*sin2)  - 
QDl**2*cos3*sin3  + 

2*QDl**2*sin2*siri3*sin23)  + 

0. 865559862383588* (~QDD2  -  QDD3  -  2*QDl**2*cos2*sin2 
2*QDl**2*cos3*sin3  +  4*QDl**2*sin2*sin3*sin23) 

=  0.  +  1 .*(-2*QD2*Qb3*cos3  -  QD3**2*cos3  + 

QDl**2*cos2*cos23  -  2*QDD2*sin3  -  QDD3*sin3  - 
QDl**2*sin2*sin23) 

=  -1.282397540605588*qDD2  - 
0. 235237993239572* (-qDD2  -  qDD3)  - 
0. 87604045969491* (-qDD2  -  2*qDl**2*cos2*sin2)  - 
0. 0555136843495328* (qDD2  ~  QDl**2*c6s2*sin2)  + 

0 . 3714692068874966* (- (qDl**2*cos2*sin2)  - 
qDl**2*cos3*sin3  + 

2*qDl**2*sin2*sin3*sin23)  - 
0. 02276697625725266* (-qDD2  -  qDD3  - 
2*qDl**2*cos2*sin2  - 

2*qDl**2*cos3*sin3  +  4*qDl**2*sin2*sin3*sin23) 

=  0.  -  1.414213562373095*cos23 

=  0.  -  1 .*qDDl*cos23 

=  -1.235954387915968*qDD2  - 
1.010507615022058*(-qDD2  -  qDD3)  - 
0 .3313261895337464*(-qDD2  -  2*qDl**2*cos2*sin2)  + 

0. 850259569166661* (qDD2  -  qDl**2*cos2*sin2)  - 
1 .676682184632862*(-(qDl**2*c6s2*sin2)  - 
qDl**2*cos3*pin3  + 

2*qDl**2*sin2*sin3*sin23)  + 

0. 919239928500904* (-qDD2  -  qDD3  -  2*qDl**2*cos2*sin2 
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Y(2,22) 

Y(2,23) 

Y(2,24) 

Y(3,l)  = 
Y(3,2)  = 
Y(3,3)  = 
Y(3,4)  = 
Y(3,5)  = 
Y(3,6)  = 
Y(3,7)  = 
Y(3,8)  = 
Y(3,9)  = 
Y(3,10) 
Y(3,ll) 
Y(3,12) 


2*C|Dl**2*cbs3*sin3  +  4*QDl**2*sin2*sin3*sin23) 

=  0.  -  l.*(-QDl**2  +  2*QDl**2*cos23**2) 

=  0.  -  1.414213562373096*(-2*qDD2*cos3  - 
QDD3*cos3  + 

qDl**2*sin3  +  2*qD2*qD3*sin3  +  qD3**2*sin3  - 
2*qDl**2*cos2*sin23) 

=  0.  +  1.732050807568877*qDDl*sin23 


0. 


0. 


0.  -  l.*sin23 


0. 


0. 


0. 


1.0 


0. 


qD3 

=  0. 


=  0. 


=  -1.571266692953117*(qDD2  +  qDD3)  - 
0.0210545949 1276347* (2*qDD2  +  2*qDD3  + 
2*qDl**2*cos2*sin2  + 

2*qDl**2*cos3*sih3  -  4*qDl**2*sin2*sin3*sin23)  + 

1 . 648454916655984* (-(QDl**2*cos2*sin2)  - 
qDl**2*cos3*sin3  + 

2*qDl**2*sin2*sin3*sin23)  - 

0. 3804528033808055* (0.5827*qDD3  -  qDl**2*cos2*sin2 
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qDl**2*cos3*sin3  +  2*QDl**2*sin2*sin3+sin23) 

Y(3,13)  =  0. 

Y(3,14)  =  1. 226745384938757* (QDD2  +  QDD3)  - 

1.441714902011356*(2*QDD2  +  2+QDD3  + 
2*QDl**2*cos2*sin2  + 

2*QDl**2*cos3*sin3  -  4*QDl**2*sin2*sin3*sin23)  - 
1 . 426858412589238* (-(QDl**2*cos2*sin2)  - 
QDl**2*cos3*sin3  + 

2*Qbl**2*sin2*sin3*sin23)  + 

0. 03954977001903942* (0.5827*QDD3  -  QDl**2*cos2*sin2  - 
QDl**2*cos3*sin3  +  2*qDl**2*sin2*sin3*sin23) 

Y(3,15)  =  -1.371048421615176*(qDD2  +  qDD3)  + 

0. 6860878137890928* (2*qbD2  +  2*qDD3  + 
2*qpi**2*cos2*sin2  + 

2*qDl**2*cos3*sin3  -  4*qDl**2*sin2*sin3*sin23)  + 

0 . 04565736647876157* (- (qDl**2*cos2*sin2)  - 
qDl**2*cos3*sin3  + 

2*qDl**2*sin2*sin3*sin23)  - 

0.2456 15598288984* (0.5827*qDD3  -  QDl**2*cos2*sin2  - 
qDl**2*cos3*sin3  +  2*qDl**2*sin2*sin3*sin23) 

Y(3,16)  =  1. 523064932932402* (qDD2  +  qDD3)  - 

0. 3815596480464399* (2*qDD2  +  2*qDD3  + 
2*qDl**2*cos2*sin2  + 

2*qDl**2*cos3*sin3  -  4*qDl**2*sin2*sin3*sin23)  - 
0 . 953445359461082* (- (qDl**2*cos2*sin2)  - 
qDl**2*cos3*sin3  + 

2*qDl**2*sin2*sin3*sin23)  - 

0.4739 123690332005* (0.5827*qDD3  -  qDl**2*cos2*sin2  - 
qDl**2*cos3*sin3  +  2*qDl**2*sin2*sin3*sin23) 


Y(3,17)  =  0.  +  l,*(qD2**2*cos3  +  qDl**2*cos2*cos23  -  qDD2*sin3) 

Y(3,18)  =  0. 957161576774482* (qDD2  +  qDD3)  - 

0. 349578303638828* (2*qDD2  +  2*qDD3  + 
2*qDl**2*cos2*sin2  + 

2*qDl**2*cos3*sin3  -  4*qDl**2*sin2*sin3*sin23)  + 

0 . 1697992859019009*(-(qbl**2*cos2*sin2)  - 
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QDl**2*cos3*sin3  + 

2*qDl**2*sin2*sin3*sin23)  - 

0. 5430206388065669* (0.5827+QDD3  -  QDl**2*cos2*sin2 
QDl**2*cos3*sin3  +  2*QDl**2*sin2*sin3*sin23) 

Y(3,19)  =  0.  -  1.414213562373095*cos23 

Y(3,20)  =  0.  -  l.*QDDl*cos23 

Y(3,21)  =  1. 034677675294261* (QDD2  +  QDD3)  - 

0. 471704994386553* (2*QDD2  +  2*QDD3  + 
2*qDl**2*cos2*sin2  + 

2*qDl**2*cos3*sin3  -  4*QDl**2*sin2*sin3*sin23)  - 
0 . 2582576467242971*(-(QDl**2*cos2*sin2)  - 
CjDl**2*cos3*sin3  + 

2*QDl**2*sin2*sin3*sin23)  - 
0 . 5233546696798646* (0 . 5827*QDD3  - 
QDl**2*cos2*sin2  - 

qDl**2*cos3*sin3  +  2*qDl**2*sin2*sin3*sin23) 

Y(3,22)  =  0.  -  l.*(-qDl**2  +  2*qDl**2*cos23**2) 

Y(3,23)  =  0.  -  1. 414213562373096* (-(qDD2*cos3)  - 
qD2**2*sin3  - 
qDl**2*cos2*sin23) 


YC3,24)  =  0.  +  1.732050807568877*qDDl*sin23 


B.5  The  Principal  Base  Parameter  Set,  P* 
The  physical  values  are  as  found  in  [13]. 


$P~*$Cl)  =  0.5464078160431836*GRAV*AA(2)*M(2)  + 

0 . 5464078160431836*GRAV*AA (2) *MC3)  + 

0 . 5464078160431836*GRAV*M(2)*XBAR(2)  + 
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0 . 3229790948354945+AA (2) *M(2) *YBAR(2) 

$P~*$(2)  =  -0.1864720673458945=^GRAV*AA(2)*M(2)  - 
0 . 1864720673458945+GRAV+AA (2) *M(3)  - 
0 . 1864720673458945iGRAV*M(2)*XBAR(2)'  + 
0.946406099039542*AA(2)*M(2)*YBAR(2) 

$p-'*$(3)  =  l.*GRAV*M(3)*ZBAR(3) 

$P''*$(4)  =  SFT0R(2) 

$P“*$(5)  =  SFTOR(l) 

$P^*$(6)  =  BN2(1) 

$P~*$(7)  =  SFTaR(3) 

$P~*$(8)  =  BN2(2) 

$P~*$(9)  =  BN2(3) 

$P'-*$(10)  =  0.5510350569644098*AA(2)*DD(3)*M(3)  + 
0.5510350569644098*AA(2)*M(3)*YBAR(3)  + 
0 . 62667434285477 12*AA (2) ♦M (2) ♦ZBAR (2) 

$p-*$(ll)  =  -0.4431256774282322*AA(2)*DD(3)*M(3)  - 
0 .4431256774282321*AA(2)*M(3)*YBAR(3)  + 
0.7792812509020994*AA(2)*M(2)*ZBAR(2) 

$P^*$(12)  =  -0.3804528033808052  - 

0 . 1383863766233774*KYY2(1)*M(1)  - 
0 .2122473170855674*AA(2)**2*M(2)  - 
0.02967614257656331*KXX2(2)*M(2)  - 
0 . 1087102340468141*KYY2(2)*M(2)  - 
0 . 1035370830387533^.KZZ2(2)*M(2)  - 
0.2122473170855674*AA(2)**2*M(3)  - 
0 . 27501467325 18451+AA (3) ♦*2*M (3)  - 
0 1383863766233774*DD(3)**2*M(3)  - 
0 . 1016742198909498*KXX2 (3) *M(3)  - 
0 . 2383025165194176*KYY2(3) *M(3)  - 
0 ,03671215673242757*KZZ2(3)*M(3)  - 
0 . 4244946341711351+AA (2) *M (2) *XBAR(2)  - 
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0 . 5500293465036903+AA (3) *M(3) *XBAR(3)  - 
0 . 2767727532467548*00 (3) *M(3) *YBAR(3) 

$P“*$(13)  =  -l.*GRAV*M(2)*YBAR(2) 

$P~*$(14)  =  0.03954977001903916  + 

0 . 2287973483287534*KYY2(1)*M(1)  + 

0 . 157235038938721*AA(2)**2*MC2)  + 

0 .03533004941978912*KXX2(2)*M(2)  + 
0.1934672989089642*KYY2(2)*H(2)  - 
0. 0362322599702432 1*KZZ2 (2) *M (2)  + 

0 . 157235038938721*AA(2)**2*M(3)  - 
0 . 2694525088995 099*AA (3) **2*M (3)  + 

0 . 2287973483287536*00 (3) ♦*2*M (3)  + 

0 . 18a8279826418586*KXX2(3)*M(3)  - 
0.3094218745864047*KYY2(3)*M(3)  + 

0 . 03996936568689477*KZZ2(3)*M(3)  + 

0 . 3144700778774421*AA (2)  *M(2)  ♦X’'.AR(2)  - 
0.5389050177990198*AA(3)*M(3)*XBAR(3)  + 
0 . 4575946966575072*00 (3) *M (3) *YBAR(3) 

$P“*$(15)  =  -0.2456155982889842  - 

0 . 01624226265009617*KYY2(1)*M(1)  + 

0 . 0939741253167811*A  •’  (2)  **2*M(2)  - 
0 . 0889235810932947*KXX2 (2) *M(2)  + 

0 . 07268131844319859*KYY2 (2) *M (2)  + 

0 . 0212928068735825 1*KZZ2 (2) *M (2)  + 

0 . 0939741253167812*AA (2) **2*M(3)  + 
0.09165564756849*AA(3)**2*M(3)  - 
0.01624226265009611*OD(3)**2*M(3)  - 
0 .5650489420980276*KXX2(3)*M(3)  - 
0.4571510318794415*KYY2(3)*M(3)  + 
0.5488065794479313*KZZ2(3)*M(3)  + 

0. 1879482506335623*AA(2)*M(2)*XBAR(2)  + 
0 . 18331129513698*AA(3)*M(3)*XBAR(3)  - 
0 . 03248452530019222*OD(3)*M(3) *YBAR(3) 

$P"*$(16)  =  -0.4739123690332002  + 

0 . 2363456990274378*KYY2 ( 1) *M( 1)  - 
0 . 178009252988034*AA(2)**2*M(2)  + 

0. 115279798595574*KXX2(2)*M(2)  + 
0.1210659004318637*KYY2(2)*M(2)  - 
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$P~*$(17) 

$P^*$(18) 


$P“*$(19) 

$P~*$(20) 

$P“*$(21) 


0 .2990751534198976*KZZ2(2)*MC2)  r 
0 . 178009252988034*AA(2)**2*M(3)  + 

0 . 1423809061828166*AA(3)**2*M(3)  + 

0 .2363456990274378*00 03) **2*M (3)  + 

0 . 14200589877006*KXX2(3)*M(3)  + 

0 . 048041 10592543898*K7Y2 (3) *M (3)  + 

0 . 0943398002573777*KZZ2(3)*M(3)  - 
0 .3560185059760682*AA(2)*M(2)*XBAR(2)  + 

0 .2847618123656332*AA(3)*M(3)*XBAR(3)  + 
0. 4726913980548757*00(3) *M(3)*YBAR(3) 

-1.*AA(2)*MC3)*ZBAR(3) 

-0.5430206388065662  - 
0.0963713135584128*KYY2(1)*M(1)  + 

0 . 1676138420435843*AA(2)**2*M(2)  - 
0.4491414325181287*KXX2(2)*M(2)  + 

0 . 3527701189597157*KYY2 (2) *M(2)  - 
0 . 1851562769161311*KZZ2(2)*M(2)  + 

0 . 1676138420435845*AA(2)**2*M(3)  + 

0 . 005511963003661525*AA(3) **2*M(3)  - 
0.0963713135584128*00 (3) **2*M (3)  + 

0. 1285618779164425*KXX2(3)*M(3)  + 

0 . 230445 15447851 72*KyY2 (3) *M(3)  t 
0 . 2249331914740557*KZZ2(3)*M(3)  + 
0.335227684087169*AA(2)*M(2)*XBAR(2)  + 

0 .01102392600732305*AA(3)*M(3)  I'XBAR(3)  - 
0 . 1 927426271168257*00 (3) *M(3) *YBAR(3) 

0 .7071067811865475*GRAV*AA(3)*M(3)  + 

0. 707106781 1865474*GRAV*M(3)*XBAR(3) 

1 .*00C3)*M(3)*ZBAR(3) 

-0.5233546696798645  + 

0.01 14877786792432*KYY2 ( 1) *M( 1 )  + 

0 . 1093526052990443*AAC2)**2*M(2)  + 

0 .4276053002863393*KXX2(2)*M(2)  - 
0 .416U75216070962*KYy2(2)*M(2)  + 

0 . 525470 1269061404*KZZ:2  (2)  *M(2)  + 

0 . 1093526052990442*AA02)**2*M(3)  + 

0 . 001895616432506327*AA(3)**2*MC3)  + 
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0 . 01148777867924333*DD(3)**2*M(3)  + 

0 . 0913817668053604*KXX2(3)*M(r3)  + 

0 . 0817896043586238*KYY2 (3) *M(3)  - 
0 . 0798939879261 171;4*KZZ2  (3)  ♦H  (3)  + 

0 . 2187652105980888*AA(2)*M(2)*XBAR(2)  + 
0 . 003791232865012653*AA(3)*M(3)*XBAR(3) 
d . 02297555735848666*DD(3)*M(3)*YBAR(3) 

$p-*$(22)  =  l.*AA(3)+M(3)*ZBAR(3) 

$P~*$(23)  =  0.707106781186547*AA(2)*AA(3)*M(3)  + 
0.707106781186547*AA(2)*M(3)*XBAR(3) 

$P“*$(24)  =  0.5773502691896258*AA(3)*DD(3)*M(3)  + 

0 . 5773502691896258*DD(3)*M(3):*XBAR(3)  + 
0 . 577350269 1896258*AA(3>M  (3)  *YBAR(3) 


B.6  Physical  Values  Used 


GRAY  =  9.80665 
M(l)  =  12.96 
M(2)  =  22.37 
M(3)  =6.97 
AA(2)  =  0.4318 
AA(3)  =  -0.0191 
DD(3)  =  0.1505 
XBAR(2)  =  -0.3289 
XBAR(3)  =  0.01466 
YBAR(2)  =  0.0050 
YBAR(3)  =  0.00845 
ZBAR(2)  =  0.2038 
ZBAR(3)  =  0.1101 
KXXl  =  0.1816 
KYYl  =  0.0152 
KZZl  =  0.1811 
KXX2  =  0.0596 
KYY2  =  0.1930 
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KZZ2  =  0.1514 
KXX3  =  0.0783 
KYY3  =  0.0786 
KZZ3  =  0.0021 
BN2(1)  =  4.5 
BN2(2)  =  3.5 
BN2(3)  =  3.5 
SFT0R(1)=  5.95 
SFT0R(2)=  6.82 
SFT0R(3)=  3.91 
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